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Abstract 

A  Kinematic  Differential  Global  Positioning  System  (KDGPS)  algorithm  is 
developed.  A  number  of  mobile  receivers  is  considered,  one  of  which  will  be  designated 
the  ‘reference  station’  which  will  have  known  position  and  velocity  information  at  the 
beginning  of  the  time  interval  examined.  Satellite  clock  biases  are  used  to  model 
Selective  Availability.  The  measurement  situation  on  hand  is  properly  rfiodeled  and  a 
centralized  estimation  algorithm  processing  several  epochs  of  data.  The  effect  of 
uncertainty  in  the  reference  receiver’s  position  and  the  level  of  receiver  noise  is 
examined.  Monte  Carlo  simulations  are  performed  to  examine  the  ability  of  the 
algorithm  to  correctly  estimate  the  non-reference  mobile  users’  position  and  velocity 
despite  substantial  satellite  clock  errors  and  receiver  measurement  noise. 
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Nomenclature 


N  Number  of  GPS  pseudorange  measurements  available  (T  /  AT) 

n  Number  of  satellites  visible 

AT  Sampling  interval 

T  Temporal  horizon  (time  duration  of  interest) 

(xj,yj,Zj)  User  position  at  discrete  time  lj’ 
xs, .  ith  Satellite  position  at  time  j 

Pij  Distance  from  the  user’s  receiver  to  satellite  i  at  time  j 

Zj  ith  GPS  pseudorange  measurement 

x  User’s  receiver  range  equivalent  clock  bias 

i  User’ s  receiver  range  equivalent  clock  drift 

i  Satellite  number,  1 , 2, . . . ,  n 

j  Discrete  time  instance,  0,  2, . .  .N 

k  Number  of  users,  1, 2, ...,  m 

m  Number  of  reference  stations 

Position  estimate 

Parameter  vector  of  interest  (positions,  velocities,  clock  biases) 
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Batch  Processing  of  GPS  Signals 


1  Introduction 

A  kinematic  DGPS  algorithm  is  developed  to  handle  GPS  pseudorange  measurements 
from  multiple  receivers  obtained  during  multiple  measurement  epochs  and  process  the 
data  in  batch  form.  The  proposed  algorithm  is  tested  to  estimate  position  and  velocity 
information  of  two  simulated,  mobile  users. 

1.1  Background 

There  are  a  growing  number  of  applications  requiring  the  ability  to  obtain  real-time, 
kinematic  positioning  of  high  altitude  formation-flying  vehicles.  These  include  Low 
Earth  Orbit  (LEO)  military  satellite  formations  for  earth  observation/surveillance,  and 
NASA’s  proposed  New  Millennium  program  [5].  Therefore,  formations  of  satellites 
might  replace  large,  complex,  satellites  and  allow  lower  overall  cost  and  a  higher  degree 
of  redundancy  [8].  Research  is  being  conducted  to  replace  or  augment  the  existing  inertial 
navigation  systems  on  board  satellites  with  GPS  receivers  to  allow  meeting  the  stringent 
positioning  requirements  for  the  formation. 

While  the  majority  of  current  research  is  focused  on  utilizing  carrier  phase  GPS 
techniques  to  acquire  position  and  velocity  information  for  each  epoch  [1, 2, 4,  8, 11], 
this  study  will  examine  the  general  principals  and  trends  in  utilizing  pseudorange 
measurements  only  over  a  series  of  measurement  epochs. 
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1.2  Problem  Statement 


The  integration  of  kinematic  modeling  and  centralized,  or  batch,  processing  of  the 
GPS  information  is  examined  for  two  mobile  users.  In  order  to  obtain  accurate 
positioning  and  velocity  information.  Differential  GPS  (DGPS)  techniques  will  be 
utilized.  Generally,  conventional  DGPS  techniques  remove  common  errors  by  directly 
differencing  a  derived  error  term  from  the  mobile  user’s  pseudorange.  The  developed 
algorithm  will  attempt  to  remove  these  errors  by  implicit  differencing  incurred  during 
batch  processing.  In  addition,  the  effect  of  uncertainty  in  the  reference  receiver’s 
position  and  the  amount  of  receiver  noise  is  investigated  to  determine  how  this  will 
influence  the  algorithm’s  ability  to  derive  the  desired  information. 

1.3  Summary  of  Current  Knowledge 

Investigation  into  the  absolute  and  relative  positioning  of  vehicles  by  use  of  GPS 
signals  is  well  documented  [6, 9].  These  include  stand-alone  and  DGPS  techniques 
utilizing  either  pseudorange  measurements  or  carrier  phase  measurements.  These 
techniques  are  briefly  described  in  Chapter  2. 

Using  GPS  for  relative  and  absolute  positioning  of  formation  flying  vehicles  is 
relatively  new  [1,  2, 4,  8],  The  majority  of  the  current  research  involves  utilizing  the 
Carrier  Phase  DGPS  techniques  for  tracking  and  controlling  vehicles.  Simulated  results 
indicate  that  <  2cm  rms  position  errors  are  possible  [1]. 
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1.4  Scope 

The  centralized  algorithm  developed  to  derive  the  user’s  position  and  velocity  will  be 
simulated  using  several  different  sets  of  parameters.  These  parameters  include  varying 
degrees  of  certainty  in  the  reference  receiver’s  position  and  velocity  as  well  as  different 
levels  of  receiver  noise.  Results  from  these  simulations  will  be  analyzed  to  determine  the 
algorithms  ability  to  handle  both  GPS  measurements  and  derive  the  user’s  position  and 
velocity. 

1.5  Assumptions 

Typical  of  any  simulation  which  attempts  to  examine  a  concept,  assumptions  were 
made  in  this  thesis  to  facilitate  development  of  the  models  and  implementation  of  the 
developed  algorithm.  These  assumptions  are: 

a)  Ephemeris  errors  associated  with  each  satellite  are  not  modeled.  This  will  leave 
GPS  satellite  clock  errors  as  the  only  error  term  induced  on  the  GPS  signal  by  the 
GPS  satellite  constellation. 

b)  The  number  of  satellites  in  view  is  held  constant  during  the  simulation. 

c)  The  two  mobile  users  simulated  are  moving  parallel  to  each  other  at  an  altitude  of 
approximately  180  nautical  miles  above  the  surface  of  the  earth. 

d)  The  effects  of  ionospheric  disturbances  will  not  be  modeled. 
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1.6  Overview  of  Thesis 

Chapter  2  presents  the  background  theory  used  to  develop  the  GPS  position  and 
velocity  determination  mathematical  models.  The  theory  summarized  in  this  chapter  was 
used  as  the  basis  to  develop  the  theory  behind  the  centralized  batch-processing  algorithm. 

Chapter  3  describes  the  theory  and  the  implementation  methodology  for  the 
developed  centralized  batch-processing  algorithm. 

Chapter  4  presents  the  results  of  each  scenario  simulated  in  this  study.  An  analysis 
and  interpretation  of  the  results  is  also  presented  in  this  chapter. 

Chapter  5  summarizes  the  research  effort  and  provides  recommendations  for  future 
enhancements  and  research  areas  as  an  extension  to  this  work. 


1-4 


2  Theory 


2.1  Overview 

This  chapter  describes  the  theory  behind  the  development  of  the  batch-processing 
algorithm  tested  in  the  Monte  Carlo  simulations.  In  addition,  the  stand-alone  and  DGPS 
algorithms  used  to  develop  the  algorithm  used  in  this  research  are  briefly  described. 

2.2  Global  Positioning  System 

The  Global  Positioning  System  consists  of  a  constellation  of  24  satellite  vehicles  (SV) 
in  six  orbital  planes  inclined  at  55  degrees  at  an  altitude  of  20,200km.  The  constellation 
continually  broadcasts  signals  that  can  be  utilized  by  a  receiver  on  the  user’s  platform. 

The  GPS  receiver  determines  the  range  from  each  visible  satellite  to  the  user’s  platform. 
This  measured  range  is  called  a  “pseudorange”  since  there  are  errors  present  on  the  GPS 
signal. 

Since  there  are  four  unknown  parameters  involved  with  GPS  positioning  (3  Cartesian 
position  parameters  x,y,  and  z,  and  GPS  time)  at  least  four  GPS  SVs  within  view  of  the 
receiver  are  required  for  a  solution.  The  pseudoranges  from  the  SVs  are  used  to 
determine  the  user’s  position  with  respect  to  Earth.  Figure  1  shows  a  typical  GPS 
scenario.  SV  geometry  plays  an  important  part  in  GPS  positioning.  Poor  SV  geometry 
with  respect  to  the  receiver  produces  high  Geometric  Dilution  Of  Precision  (GDOP), 
which  can  wreak  havoc  on  GPS  position  solutions  [6]. 
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Civil  Standard  Positioning  Service  (SPS)  receivers  are  subjected  to  Selective 
Availability  (SA),  an  additional  error  intentionally  injected  onto  the  GPS  signal  by  the 
GPS  Mission  Control  Segment.  SA  decreases  the  positioning  accuracy  of  stand-alone 
receivers  to  within  100-meters  RMS.  Military  receivers  utilize  de-encryption  techniques 
to  remove  SA  and  provide  position  accuracy  of  10-meters  root-mean-square  (RMS)  [6]. 


2.2.1  Stand-Alone  GPS  Positioning 

Single  point,  or  stand  alone,  GPS  techniques  utilize  signals  broadcast  from  the  GPS 
satellites  as  depicted  in  Figure  1.  First,  a  nominal  state  (consisting  of  user  position 
coordinates  and  receiver  clock  error)  can  be  represented  as 


x..  = 


X 

y 

z 

cdt 


= approximate  state 


(2-1) 
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At  a  given  measurement  epoch,  the  GPS  receiver  generates  a  set  of  n  pseudorange 
equations  (where  n  is  the  number  of  satellites  visible  to  the  receiver).  The  pseudorange 
from  the  user  receiver  to  the  i*  satellite  is  the  sum  of  the  true  range  plus  the  receiver 
range  equivalent  clock  error  (i.e.,  after  ionospheric,  tropospheric,  etc.  errors  have  been 
removed) 

P'user  =  VS  -  Xuser  f  +  (j,  ~  Vuser  f  +  (Z,  "  Zuserf  +  cSt  (2-2) 

where 

(xUSer,  yUSer,  zuser)  =  ECEF  position  coordinates  of  the  user  (m) 

(Xj,  y*,  Zj)  =  ECEF  position  coordinates  of  the  i*  satellite  (m) 

c5t  =  Range  equivalent  receiver  clock  error  (m) 

Although  these  equations  are  generally  non-linear,  several  solution  techniques  have 

been  developed.  These  include  closed  form  solutions,  Kalman  filtering  and  Iterated  Least 

Square  (ILS)  techniques  based  on  linearization  [6, 9].  Since  the  ILS  algorithm  is  most 

commonly  used,  it  will  be  subsequently  explained. 

Since  the  position  of  the  user  is  not  known,  an  estimate  of  the  user  position  ( x ,  y,  z)  is 

used  to  generate  a  set  of  estimated  pseudoranges  to  each  of  the  n  satellites,  i.e. 

Pi,  =  l/(*.  +(y,  -  JZ)2  +(z,  (2-3) 

The  relationship  between  the  true  and  the  estimated  position  with  errors  can  be  written  as 

xu  =x„  +Axu  (2-4) 

The  approximated  pseudorange  equations  (Equation  (2-3))  are  then  linearized  using  a 
first  order  Taylor  series  approximation  to  yield 

Ap=HAx-c<St„  (2-5) 
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where 


Ap  = 

A A 

H  = 

ax\  ay\  az\  1 

Ax  = 

"  Ax„ 

.A Pn_ 

aX\  ay\  az\ 

-cLSt 

The  values  (axi,  ayi,  azi)  are  unit  vectors  from  the  linearization  point  to  the  i**1  satellite. 
Solving  equation  (2-5)  has  the  solution 

Ax=H_1Ap  (2-7) 

The  values  obtained  for  Ax  are  used  to  update  equation  (2-4)  for  the  users  position. 

There  are  three  possible  cases  to  be  considered.  If  there  are  fewer  than  four  satellite 
pseudoranges  available,  the  position  cannot  be  determined  since  Ax  cannot  be  resolved. 

If  there  are  exactly  4  pseudoranges,  there  will  be  a  unique  solution.  However,  if  there  are 
more  than  four  satellites  visible,  as  is  generally  the  situation,  an  overdetermined  linear 
system  is  obtained,  and  no  solution  will  be  available  that  will  perfectly  solve  the  equation 
in  Ax.  For  this  case,  the  least  squares  solution  concept  can  be  utilized. 

Basic  least  squares  techniques  yield  the  solution 

Ax=(HrH)-‘HrAp  (2-8) 

Alternatively,  a  weighted  least  squares  solution 

Ax=(HrC;1H)'1HrC;1Ap  (2-9) 


can  be  used  when  it  is  believed  (as  is  usually  the  case)  that  the  pseudorange 
measurements  have  different  error  statistics  or  that  the  pseudorange  measurement  errors 
are  correlated.  Cp  is  the  measurement  error  covariance  matrix.  (Diagonal  terms  are 
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measurement  error  variances  and  off-diagonal  terms  show  cross-correlation  between 
measurement  errors). 

For  the  over-determined  case,  there  is  generally  no  solution  for  Ax  that  exactly  solves 
the  measurement  equation.  However,  measurement  residuals,  v,  can  be  applied  to  the 
measurements  which  would  result  in 


Ap=HAx+v  (2-10) 


n=Ap-HAx  (2-11) 

Single  point  positioning  estimates  only  receiver  clock  errors,  and  requires  a  correction 
for  the  satellite  clock  error.  Satellite  clock  error  corrections  can  be  accomplished  as 
described  in  ICD-GPS-200C 

Pcorr'c,ed=P+Ctosv  (2-12) 

where, 


Atsv 

=  aro  +  an(t  -  to)  +  af2(t-to)2  +  Atr 

Atr 

=  FeVa  sin  (Ek) 

Pcorrected 

=  pseudorange  corrected  for  SV  clock  error 

P 

=  pseudorange 

cAtsv 

=  SV  clock  correction 

aro,  an,  an.to 

=  SV  clock  correction  parameters  from  navigation  message 

Atr 

=  relativity  correction  (since  not  circular  orbit) 

F 

=  constant  =  -4.442807633xl0'10  sec/(meter)1/2 

e 

=  eccentricity  from  navigation  message 

Va 

=  square  root  of  semi-major  axis  from  navigation  message 

Ek 

=  Eccentric  anomaly  (from  S  V  position  calculation) 

Stand-alone  GPS  positioning  techniques  are  fast  and  reliable.  However,  the  poor 
accuracy  results  (typically  30-50  m )  are  undesirable.  In  order  to  obtain  the  relative 
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accuracy  required  for  vehicle  formation  flying,  kinematic  and  DGPS  techniques  must  be 
employed. 


SV1 


\ 


Y* 


SV4 


A>y 


SV2 


/cy^3 

/ 


\  ' 

/ 

; 

\  /  / 

v 


i 


Mobile  User 

DifTertntitl  Sign*!  * 

Figure  2.  Typical  DGPS  Situation 

2.2.2  Differential  GPS  Positioning  Techniques 

The  principal  idea  behind  DGPS  is  that,  because  a  reference  receiver’s  position  is 
known,  common  errors  between  it  and  relatively  close  mobile  receivers  can  be  removed. 
Generally,  there  are  two  basic  DGPS  techniques;  code  and  carrier-phase  based. 

2.2.2.1  Code  Based  Algorithm 

Let  the  reference  receiver,  m,  have  a  known  position  represented  as  (xm,  ym,  zm)  and 
the  reported  i*  satellite  position  (via  ephemeris  data)  be  represented  as  (Xj,  yi,  z\).  The 
geometric  distance  from  the  reference  receiver  to  the  i*  satellite  is  known  and  can  be 
represented  as 
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K  =  fa  -*J2 + (y,  -  yJ2 + (z*  -  O2  (2'13) 

The  reference  receiver  is  then  able  to  generate  a  pseudorange  measurement  to  the  i 
satellite  as 

PL=K+  space  +  +  cStm  (2'14) 

where  em,sPace ,  £m, control  and  Em,user  are  the  space,  control,  and  user  segment  induced 
pseudorange  errors  respectively,  and  c8tm  is  the  reference  receiver  s  clock  offset  from 
GPS  time.  The  errors  are  summarized  in  Table  1  [6].  The  reference  receiver  simply 
resolves  the  difference  between  the  generated  pseudorange  to  the  i*  satellite,  p'm  and  it’s 

geometric  range,  R[m ,  to  create  the  desired  correction  term. 

&Pm  =  Pm  ~  R’m  ~  ^m, space  £m,  control  £m,user  ^  ^ 

This  correction  term  utilized  by  the  user,  or  mobile,  receiver  where  it  is  differenced 
with  the  users’  generated  pseudorange  measurement  to  the  same  satellite  is 


Pu  A Pm  ~R]u  ^u, space  ^u, control  "**  ^ u.user  ^St ... 

•••  —  (Pm,  space  +  ^  m,  control  ^m.user  + 


(2-16) 


If  the  user’s  receiver  is  located  relatively  nearby  the  reference  receiver,  the  user’s 
receiver  pseudorange  equation  error  components  will  be  nearly  identical  to  those  of  the 
reference  receiver.  Exceptions  include  errors  that  are  not  common  to  both  receivers,  i.e., 
multi-path  and  receiver  noise.  Therefore,  the  corrected  user  pseudorange  is  obtained  as 

Pu, corrected  =^u  combined  (2 
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where  £u  is  the  residual  user  segment  error  (multi-path,  etc)  and  8t  combined  is  the  combined 

clock  offset.  A  typical  comparison  between  stand-alone  measurements  and  DGPS 
measurements  is  given  in  Table  1  [6]. 


Table  L  Typical  Satellite  errors  before/after  DGPS  correction 


Segment  Source 

Error  Source 

GPS  la 
Error  (m) 

Typical  GPS  la 
errors  after  DGPS 
corrections 

Space 

Satellite  clock  stability 

3.0 

0 

Satellite  perturbation 

1.0 

0 

Selective  Availability 

32.3 

0 

Other  (thermal,  radiation,  etc) 

0.5 

0 

Control 

Ephemeris  prediction  error 

4.2 

0 

Other  (thruster  performance,  etc) 

0.9 

0 

User 

Ionospheric  delay 

5.0 

0 

Tropospheric  delay 

1.5 

0 

Receiver  noise  and  resolution 

1.5 

2.1 

Multipath 

2.5 

2.5 

Other  (inter-channel  bias,  etc) 

0.5 

0.5 

System  UERE 

Total  (rms) 

33.3 

3.3 

22.2.2  Carrier-Phase  Based  Algorithm 

Obviously,  more  precise  position  information  can  be  obtained  by  measuring  the 
amount  of  shift  in  the  frequency  (Doppler  shift)  of  the  received  signal.  This  shift  in 
carrier  frequency  arises  from  the  relative  motion  of  the  GPS  satellites  to  the  user 
resulting  in  Doppler  shift  frequencies  of  A/ =±  5000  Hz .  Thus, 

A/=/«-/r  (2-18) 

where, 

/r  =  Frequency  received  at  the  receiver 
/t  =  Known  transmitted  frequency 

Integration  of  the  Doppler  shift  offset  over  time  can  result  in  extremely  precise 

measurements  (centimeter  range  for  the  LI  and  L2  frequencies).  Thus,  the  carrier  phase 
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measurements,  <|>(t),  can  be  calculated  by  integrating  the  Doppler  measurements  over  the 
time  epoch: 


W)  =  J  A/mOTJ  )  (2-19) 

0 

The  integer  portion  of  the  initial  carrier-phase  at  the  start  of  the  integration,  0(t),  is 
referred  to  as  the  “carrier-phase  integer  ambiguity.”  This  integer-ambiguity  exists 
because  the  receiver  merely  begins  counting  carrier  cycles  once  the  user  tracks  the 
satellite  signal.  Resolution  of  this  integer  ambiguity  is  paramount  in  determining  the 
most  precise  range  measurement  possible.  Several  techniques  have  been  utilized  to 
resolve  this  problem,  most  popular  of  which  are  the  least-squares  iteration  process  or 
LAMBDA  methods  [3, 7, 10]. 

2.2.3  General  Kinematic  GPS  Techniques 

In  some  of  the  less  advanced  receivers,  user  velocity  is  calculated  as  the  time 
derivative  of  the  estimated  position,  i.e. 


_  du  u(t2)-u(tl) 


dt 


* 2  *1 


(2-20) 


In  general,  this  approach  yields  poor  results  and  is  acceptable  only  if  the  user’s  velocity  is 
constant  over  the  selected  time  interval. 

Many  receivers  process  carrier  phase  measurements,  which  effectively  estimate  the 
Doppler  frequency  of  the  received  satellite.  The  satellite  velocity  vector  is  computed 
using  the  ephemeris  data  and  an  orbital  model  that  resides  within  the  receiver  [6].  At  the 
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receiver  antenna,  the  received  frequency,/*,  is  given  by  the  classical  Doppler  equation 
(neglecting  relativistic  effects)  as  follows 

/*=/r(  1-^-^)  (2-21) 

c 

where, 

fr=  transmitted  satellite  signal  frequency  (known) 
vr  =  satellite-to-user  relative  velocity  vector 

a  =  is  the  unit  vector  pointing  along  the  line  of  sight  from  the  user  to  the  satellite 
c  =  speed  of  light 

The  dot  product  represents  the  radial  component  of  the  satellite-user  relative  velocity 
vector  along  the  instantaneous  line  of  sight  to  the  satellite  vector,  ar.  The  quantity  vr  is 
given  as  the  velocity  difference 

vr=v-u  (2-22) 

where  v  is  the  (known)  velocity  of  the  satellite  and  u  is  the  velocity  of  the  user  to  be 
determined  (both  referenced  to  a  common  ECEF  frame).  Therefore,  the  Doppler  offset 
due  to  the  relative  motion  satisfies 

A (2-23) 

c 

There  are  several  techniques  to  obtain  user  velocity,  u,  from  the  measured  Doppler 
frequency,  A f . 

For  the  j*  satellite,  equation  (2-23)  yields 

/*,  =  (2-24) 

and  the  corrected  satellite  frequency  is  given  by 
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flj  ~  So  ■*"  Afl Tj 


(2-25) 


where /0  is  the  nominal  transmitted  frequency  (LI  or  L2)  and  AfTj  is  the  correction 

determined  from  the  navigation  message  update. 

The  measured  value  of  the  received  frequency  is  in  error  due  to  the  frequency  bias 

offset.  This  offset  is  related  to  the  drift  rate  of  the  user  clock,  relative  to  GPS  time,  by 

/*,=/,  (!  +  <*„)  (2-26) 

where  dtu  is  considered  positive  if  the  user  clock  is  running  fast.  Through  algebraic 

manipulation,  this  can  be  rewritten  as 

c(fj  ~  fTj )  ...  cfjdt 

- — I-  v  a  ■  +  v  a  .  +  v  a  .  =x  a  .  +  v  cl  ■  +  z  a  ■ - - —  ( 2-27 ^ 

/.  V  X]  X]  yj  yj  ZJ  ZJ  u  XJ  j  U  yj  ^U^zj  r  X*  ! ) 

Tj  JTj 

where  Vj,  aj  is  the  j*11  satellite  velocity  and  acceleration  component  respectively  and 
xu,yu, zu  is  the  user  velocity,  V.  To  simplify  this  equation,  we  let 


dj  = - 7 - +  Vxja*j  +Vyjayj  +  V1* 

JTj 


(2-28) 


Since  the  term  fjlfTj  is  =  1,  the  equation  can  be  written  as 


dj  =  xuaxj  +  yuayj  +  zua -  cSt  (2-29) 

We  now  have  four  unknowns  that  can  be  solved  for  by  using  measurements  from  four 
satellites  and  using  a  set  of  linear  equations,  i.e., 


(2-30) 
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with  the  general  form 


d  =  Hg 


(2-31) 


which  can  be  solved  as 


g  =  H~‘d 


(2-32) 


The  previously  stated  technique  for  obtaining  user  velocity,  equation  (2-32),  uses 
measurements  that  may  be  corrupted  by  (measurement)  noise  and/or  multi-path  errors.  A 
Kalman  Filter  method  may  be  used  to  compute  a  smoothed  navigation  solution. 

The  Kalman  filter  technique  is  a  recursive  algorithm  that  provides  optimum  estimates 
of  user  position,  velocity  and  clock  drift  (PVT)  based  on  noise  statistics  and  current 
measurements.  The  filter  contains  a  kinematic  model  of  the  GPS  receiver  platform  and 
outputs  a  set  of  user  receiver  position  and  velocity  state  estimates  as  well  as  the 
associated  error  variances.  Kalman  Filters  entail  an  approach  which  simultaneously 
estimates  eight  states:  3  position  states,  3  velocity  states,  1  receiver  clock  bias  and  1 
receiver  clock  drift.  In  general,  the  velocity  estimates  are  only  valid  for  low  dynamic 
situations. 

Generally,  the  dynamical  model  can  be  derived  from  a  Taylor  series  expansion 


dt 


2!  dt i 


,  1  A i3(0  | 

3!  dt 3  U° 


(t-t0)3  +h.ol 


(2-33) 


In  summary,  the  filter  propagates  the  platform  position  from  one  time  point  to  the 
next.  Using  these  propagated  states,  the  receiver  calculates  the  anticipated  pseudorange 
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and  delta  pseudorange  (the  change  in  pseudorange  per  epoch  for  each  satellite).  Next,  the 
pseudorange  and  delta  pseudoranges  are  measured  and  the  difference  between  the 
anticipated  and  the  measured  values  (residuals  or  errors  in  the  user  position  and  velocity 
estimates)  is  taken.  These  errors  are  usually  sent  back  through  the  algorithm  to  be 
utilized  in  future  state  estimates. 

Utilizing  a  Kalman  filter  allows  the  use  of  fewer  then  4  satellites  and  adjusts  the  state 
estimates  to  weight  the  effects  of  measurement  noise.  That  is,  when  measurement  noise 
is  high,  the  filter  places  heavier  weights  on  the  state  estimates  while,  on  the  other  hand, 
the  filter  places  heavier  weights  on  the  measurements  when  the  noise  is  low. 

2.3  Summary 

This  chapter  described  the  conventional  GPS  techniques  used  to  determine  user 
position  and  velocity.  The  use  of  DGPS  techniques  allows  the  removal  of  nearly  all 
common  errors  in  each  of  the  three  segments  (User,  Control,  and  Space)  as  can  be  seen  in 
Table  1.  However,  errors  that  are  uncorrelated  from  receiver  to  receiver  are  not  removed 
and,  in  particular,  the  receiver  measurement  noise  is  actually  increased.  In  addition,  the 
theory  behind  the  new  algorithm  is  described. 
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3  Novel  DGPS  Position-  Velocity  Estimation  Algorithm 

3.1  Overview 

This  chapter  provides  a  detailed  description  of  the  novel  algorithm  developed  to 
estimate  user  position  and  velocity.  Only  pseudorange  measurements  are  used. 

3.2  Problem  Statement 

Two  or  more  mobile  users  are  considered  over  a  pre-specified  short  time  interval. 

The  number  and  the  specific  GPS  satellites  in  view  of  the  users’  platforms  is  held 
constant  during  the  measurement  interval. 

At  the  beginning  of  the  time  interval,  prior  information  on  user  2’s  position  (and 
velocity)  is  available.  Pseudorange  data  is  collected  over  several  epochs  during  the 
measurement  interval;  a  fixed  sample  rate  is  used.  The  prior  information  and  all 
pseudorange  measurements  are  processed  simultaneously  at  the  end  of  the  measurement 
interval  and  estimates  of  the  position  and  velocity  of  both  users  1  and  2  are  obtained.  The 
effect  of  having  varying  degrees  of  uncertainty  in  the  user  2’s  “reference  station”  prior 
position  information  is  examined.  Additionally,  the  effect  of  receiver  noise  on  the 
algorithm’s  ability  to  correctly  estimate  the  users’  position  and  velocity  in  the  face  of  user 
and  satellite  clock  errors  is  investigated. 

3.3  Theory 

The  developed  novel  algorithm  integrates  kinematic  modeling  and  differential  GPS. 
This  is  achieved  by  maximizing  the  use  of  the  information  in  the  pseudorange 
measurements  from  n  satellites  that  are  available  at  N+l,  relatively  close,  time  instants 
during  the  measurement  interval.  The  correct  treatment  of  the  common  errors,  and 
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proper  stochastic  modeling  of  the  measurement  situation  on  hand,  are  responsible  for 
achieving  improved  user  positioning. 

A  sampling  interval  of  AT  seconds  is  used.  The  duration,  T,  of  the  measurement 
interval  consists  of  N+l  discrete  measurement  epochs.  Thus,  the  time  instants  when 
measurements  are  taken  are 


tj=&T-j  (3-1) 

where 

7=0,1,...,  N  (3-2) 

Hence,  the  number  of  epochs  available  over  the  duration  of  the  measurement  interval  is 
N+l  where 


(3-3) 


For  the  short  measurement  duration,  T,  being  investigated,  the  users’  kinematics  are 
modeled  as  constant  speed  and  rectilinear  motion,  viz., 

xk(t)=x0t+Vrt  (3-4) 


where  k  =  1, 2, . . . ,  m  and  m  is  the  number  of  users  and  xk ,  x0i ,  Vk  e  SH3 . 

The  kinematic  model  could  include  higher  order  terms  such  as  acceleration,  jerk  or,  more 
importantly,  could  represent  a  more  complex  motion  (i.e.,  a  satellite  trajectory 
parameterized  by  its  orbital  parameters).  However,  for  the  generic  scenario  examined, 
equation  (3-4)  will  be  the  kinematic  model  chosen  for  the  users’  motion. 

The  pseudorange  from  the  kth  user  to  the  i*  satellite  measured  at  time  t  is  modeled  as 

Zjk)  =  pjk)  (t) + v,(t)  (t)  (3-5) 
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where  the  pseudorange 


p\k)  (0  =  VI**  (*) _  x*,  wf + bk  (0  -  y„  wF + k  (0  -  zSi  (t)f 


+  Tk  +  Ts, 


(3-6) 


and 

v\k)  (t)  is  the  measurement  noise  in  the  i111  channel  of  user  it**1  receiver  at  time  t. 

Tk  is  the  k01  user  range  equivalent  clock  bias. 
rSj  is  the  ith  satellite  range-equivalent  clock  bias. 

(xs. ,  ys. ,  zs. )  is  the  Ith  satellite  position  from  the  ephemeris  data. 

(xk ,  yk ,  zk )  is  the  k*  user  position  at  time  t,  k=l,  2, ...,  m. 
i  is  the  satellite  number  (number  of  satellites  in  view  is  ri). 

The  measurement  noise  at  time  j  is  modeled  as 

vlj=N( 0,<72)  (3_7) 


and 

E(y\k]-vfj)= 0  for  i*i’,j  *  j’ork*k'.  (3-8) 

Incorporating  the  kinematic  modeling  of  Equation  (3-4)  for  the  users  positions  for  each 
time  instant,  i.e.,  setting 


xk  (0  xot  +  (Vkx  ‘  &T)j 

yk(t)->y0k  +  (VA  T)j 
Zk  (0  zok  +  (Vkz  *  AT); 

where  the  subscript  ‘0’  denotes  the  initial  position  at  time  t= 0  (/= 0)  and 

7=0,1,...,  N, 


allows  Equation  (3-6)  to  be  written  as 

a7  =  Vk  +(v*.  ArW--t„«)f +k  +<v,, 

+  Uot  +(Vkz  ’AT);- zSl(t) f  +Tk  +TSj 


(3-9) 


(3-10) 


(3-11) 
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Note  that  in  Equation  (3-11),/  =  jAT . 
The  parameter  vector  of  interest  is 


where 


U1 

VAT 

xi 

V  AT 

y< 

VZAT 

xo2 

y* 


9= 


VAT 

x2 


V  AT 

y2 

V.  AT 

z2 

T l 


f 2 


(3-12) 


(*o*  >  >’0i  >  ^ok )  is  the  k  user  initial  (/  =  0)  ECEF  coordinates,  k  =  1 ,  2,... ,m. 

(Vxk  ’Vy„  >Vzk  )is  the  k*  user  velocities,  k  =  1, 2, m. 

Tk  represents  the  kth  users  range-equivalent  receiver  clock  error,  k  =  1, 2,. . . ,m. 

TSj  represents  the  i*11  satellite  range-equivalent  clock  error,  i  =  1, 2, n. 

In  the  case  where  two  users  (m= 2)  and  five  (n= 5)  satellites  are  considered,  the  parameter 
vector  is  shown  in  Equation  (3-12)  and  9e  ft19 .  In  the  general  case,  the  parameter 

Oe‘Rlm+n  (3-13) 
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In  the  algorithm,  the  pseudoranges  received  are  composed  systematically.  First,  the 
pseudoranges  received  by  the  kth  user  from  n  satellites  at  time  instant  j  are  used  to  form 
the  n  x  1  vector 


7«0  _ 
- 


j 


(3-14) 


Now,  composing  the  received  pseudoranges  over  the  N+l  time  instants  yields  the 
n(N+l )xl  vector 


( 


<•(*)  _ 


zf 

v  N  ) 


(3-15) 


and  finally,  composing  for  the  m  users  yields  the  mn(N+l )xl  “measurement”  vector 


(  Zd)  ^ 


Z  = 


z(m) 

V  J 


(3-16) 


The  pseudorange  information,  p(0) ,  is  composed  similarly:  Defining 
W  =  Vk  +  (^  •  A7">j  -  (Of  +  k,  +  (Yyk  •  A T)j  -  y,t  (Oj2 

...+k 


(3-17) 


and 

PuW=f,(j\0)+Tk+rSi  (3-18) 

we  compose 
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(3-19) 


f  f(k)\ 


fjk)  = 


Jij 


f(k) 

\JnJ  J 


Next,  composing  the  N+l  time  epochs  we  obtain 


/'*>  =' 


f  (*) 

\Jn  y 


(3-20) 


and  finally,  composing  for  the  m  users  yields 


(  fm 


/  = 


V  ) 


(3-21) 


The  vector/is  mn(N+l)xl.  The  vector  p  is  similarly  composed,  thus  obtaining  the 
function  p(0):  9t7m+n 

The  (nonlinear)  GPS  equations  are 

Z=p(0)+W  (3-22) 

where  the  mn(N+l)  equation  error  vector  W  represents  the  composed  measurement  noise 


/V1^ 

M,0 


w= 


,(m ) 


(3-23) 


V  n,N  Jmn(N+l)xl 


with  covariance 

Rl=E(W-WT)=(72Imn^i)  (3-24) 

Linearization  with  respect  to  the  parameter  0,  at  the  1th  iteration,  about  the  current 
parameter  estimate  0O) ,  yields 
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Z=p(0W)+^  (, 0-0^)+W 


JP 


d0 


(O' 


(3-25) 


0=0" 


Equation  (3-25)  is  rearranged  to  yield  the  linear  regression  in  0 


Z  +  - 


d0 


8=8 1 


5(0 


off 


0  +  W 


9=e<" 


(3-26) 


Now,  the  calculation  of  the  regressor  matrix  requires  the  composition  of  the 
partials  of  p(0)  with  respect  to  the  parameter  vector# ,  i.e. 


H-j(0)  = 


a# 


(3-27) 


Hjj  is  an  l\(7m+n)  row  vector.  Its  entries  are  explicitly  given  by 


H^(0)=- 


ftfiP) 


[°T  ■  Ei,k  O’)  -  %  O’)  -  ys,j e2t,  U)  -  zSii e3jt  (y)]+  eitk  (3_: 


28) 


where 

(xs,  t ,  ySj  k ,  zs.  t )  is  the  ith  satellite  position  at  time  j. 

ei,k  0\\k  (;),%  (j)>e  3(,  U)  are  7m+4n  row  vectors  of  zeros  with  Vs,j,  and  / 
located  at  positions  indicated  in  their  subscripts,  according  to: 

eh,k  0)  —  eik-6,7k-3,lm+4i-3  e2ik  0)  =  eik-5Jk-2,7m+4i-2 

e3:i  0)  =  e7i-9,7*-l,7m+4i-l  Ci,k  =eik,lm+4i » 

and  the  matrix 


£,  k  (j)  =ej  e.  +el  e,  +el  e,  . 

hjt  ii,k  2i,k  2i,i  3i,k  *i.k 


(3-29) 


The  composition  of  the  regressor  matrix  is  analogous  to  the  process  employed  for  Z  and/. 
First,  for  the  n  satellites,  the  n\(7m+n)  matrix 


3-7 


Hf{d)=  :  (3-30) 

is  formed,  followed  by  composition  over  the  N+l  time  epochs,  yielding  the 
n(N+l)x(7m+n)  matrix 

rH(ok\0)' 

Hw{0)=  \  (3-31) 

Hf{0) 

\  J 

Finally,  for  the  m  users,  the  mn(N+l  )x(7m+n)  regressor  matrix 

H(0)=  :  (3-32) 

H(m\0 ) 

) 

is  formed.  Thus,  Equation  (3-26)  yields 

Z+$-  -Oil)-f(0(  l))  =  ^-  0  +  W 

°0e=9"  009=9"  (3-33) 

=H(0a))0  +  W 

The  function  p(0) :  917m+"  — >91m''(A'+1)  is  linear  in  the  users’  and  satellites’  clock  error 
parameters  and  therefore  the  function  p(0)  is  replaced  by  the  function  f(0)  in  the  left 
hand  side  of  Equation  (3-33). 

The  solution  for  the  users’  “positions”,  viz.,  0,  can  be  obtained  using  least  squares, 
whereupon,  the  Iterated  Least  Squares  (ILS)  algorithm  is  established: 

0{M)  =  (H  T  (0(l) )  •  H(0il)  ))_1  (H(0a)  ))T  [Z+$f-  (3-34) 

00  e=gi.D 
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where 


Z  is  the  received  ‘stacked  up’  pseudorange  measurements  mti(N+l)xl  vector 
according  to  Equation  (3-16) 

/  is  the  mn(N+l )xl  vector  of  ranges  calculated  according  to  Equation  (3-17) 

H  is  the  mn(N+l )x(7m+n)  regressor  matrix  formed  from  the  partials  of  p 
according  to  Equation  (3-32). 

3.3.1  Reduced  parameter  vector 

The  regressor  H  is  further  examined.  As  stated  in  equation  (3-12),  the  parameter 
vector  contains  7m+n  variables:  3  positions,  3  velocities  and  a  clock  bias  variable  for 
each  of  the  two  (m=2)  users,  as  well  as  the  five  (n=5)  satellite  clock  error  terms  (19 
variables  in  total).  The  main  objective  of  the  algorithm  is  to  solve  for  the  (non-reference) 
users’  position  and  velocity  rather  than  the  users’  and  satellites’  clock  biases.  Hence,  the 

regressor’s  matrix,  H(0O) ) ,  structure  is  examined  and  the  algorithm  is  modified 
according  to  the  following  analysis. 

We  define  the  mn(N+l )x(m+n)  matrix 

B=[b1)b2 . b  m,rvr2,...yn]  (3-35) 

where 

bk  is  the  column  of  H  operating  on  user  k' s  clock  variable,  k  =  1 , 2, . . . ,  m 
Yi  is  the  H  column  operating  on  the  Ith  satellite  clock  variable,  i  =  1 , 2, . . n 

Indeed,  the  structure  of  the  regressor  matrix  H(0O) )  is 

H=[Diag(H(k)0(,))\B]  (3-36) 

where  the  n(N+l)x6  matrices  H(k)  are  the  H(k)  matrices  with  only  the  six  columns  6k-5, 
...,6k  retained.  In  the  case  where  m= 2,  and  therefore,  k=  1,2, 
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H  = 


Hm(0m) 


0 


0  H(2\0O)) 


B 


(3-37) 


where  the  H{ }and  H{  )  matrices  are  given  by  the  partials  of /in  (v  >v  V  AT . 
VyAT,  VZA T)  and  (  jc„2  ,  y02 ,  z0i ,  VXiA T,  VyiA T,  T),  respectively.  The  matrix 


B= 


Diag(eN+l)  : 

I. 


(3-38) 


where 


eN+i  is  a  vector  of  ones  of  size  (N+l )  x  1 
In  is  an  identity  matrix  of  size  n 


For  example,  for  m=2 


The  following  holds 


B= 


' N+l 

0  e 


0 

N+l 


(3-39) 


hi  m 

Xbk=2>, 

k=1  i=1 


(3-40) 


Evidently,  the  matrix  B  (and  therefore  the  regressor  H)  is  rank  deficient.  Thus  perform 
the  full  rank  factorization  of  B, 


B=BXK 

where  Bi  is  a  full  rank  ( m+n-1 ),  mn(N+l )x(m+n-l )  matrix  of  the  form 


(3-41) 


B,= 


rn 


*=1 


(3-42) 
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In  the  case  where  m—2 


B,  =(b]/b1  +b 2.y, yn_}] 


(3-43) 


Therefore,  solving  Equation  (3-41)  for  K  yields  the  blocked  (m+n-l)x(m+n)  matrix 


K  = 


ABC 
D  E  F 


where 


A  = 


An-1  ®m-1 

Olx(m-I)  ^ 


1 


D  =  0 


(n-1)xm» 


^  Awl 1  —  ®n-1 


where 


0  is  a  zero  matrix 

en  is  a  vector  of  ones  of  length  n 


Next,  partition  the  regressor 


H=[HlB ] 


(3-44) 


(3-45) 


(3-46) 


where#  =Diag(H{k)) is  a  mn(N+l)x6m  matrix  consisting  of  the  columns  operating  on 
the  users’  position  and  velocity  parameters  only.  Also  define  the  reduced,  full  rank, 


matrix 


#,=[#:£,].  (3-47) 

Next,  perform  the  full  rank  factorization  of  the  regressor  H 

H=H1Kl ,  (3-48) 

i.e.,  the  following  equation  is  solved  for  the  (7m+n-l)x(7m+n)  matrix  Ki: 

[HlB^MHlBJK,  (3-49) 
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We  calculate: 


K,= 


I 


(6m)x(6m) 


0 


(6m)x(iTH-n) 


0  K 

u(m+n-l)x6m  rx(m+n-l)x(mxn) 


Finally,  the  reduced  parameter  vector  is  defined, 

e^e 


(3-50) 


(3-51) 


where  0  is  as  specified  in  Equation  (3-12)  and  the  reduced  parameter 
vector  0je  $R7m+n"1  consists  of  the  users’  position  and  velocity  parameters  as  well  as  linear 
combinations  of  the  user  and  satellite  clock  biases.  For  the  specific  scenario  examined  in 
which  we  have  2  mobile  users  and  5  satellites  visible,  this  yields 


e.= 


A0, 

A 

zo, 

VxlAT 
VyA  T 
VZA T 

X®2 

y02 


vxA  T 

VyAT 

VZA  T 

*1 

~*2 

* 2 

+  *s5 

*sl 

-*s5 

*s2 

-*sS 

-ts5 

*s4 

~ts5 

(3-52) 
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Since 


HO  =  HxKx0  =  HX0X  (3-53) 

Equation  (3-33)  is  written  with  the  reduced  parameter: 


Z +  H2  (0<° )  •  -  /(0<° ) = Hx  (<9f )  •  6X  +  W  (3-54) 


where 


02  = 


>0, 

zo, 

VXAT 

V  AT 

y\ 

VZAT 

xo2 

yo2 

zo2 

V,  AT 

x2 

V  AT 

y2 

Vz  AT 

\  Zl  J 


(3-55) 


Hence,  is  stripped  of  the  clock  error  parameters  of  0\  and  is  used  in  the  left  hand  side 


of  Equation  (3-54)  (not  0\)  because  the  function  p  is  linear  in  the  time  parameters.  Hi  is 
composed  of  the  first  6m  columns  H  associated  with  the  parameters  featuring  in  &i 
(positions  and  velocities,  and  no  clock  biases).  Thus,  H2  =Diag(H(k) ) . 


Finally,  the  linear  regression  is  augmented  to  include  the  prior  information  on  user  2 
(position  and  velocity).  The  prior  information  is  provided  in  the  form 
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*0 ,2=W(*o2,<) 
Zo2=H(z02,<rzZoi) 

vX2=N(yXi,*l) 

Vy2=N(Vy2,azn) 

V'2=n(vZ2<) 


(3-56) 


This  enables  the  augmentation  of  the  linear  regression  in  Equation  (3-54).  The  linear 
regression  is  augmented  as  follows.  The  vector  Z  is  augmented  in  Equation  (3-57): 


where 


In  addition, 


H,:= 


where  the  6x(7m+n-l )  selector  matrix  M\  is 

M,=[<U  :  h  '■  06J 


(3-57) 


(3-58) 


(3-59) 


(3-60) 
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and  when  added  to  H\  picks  out  the  x0j ,  y02 ,  z0i ,  VX2  &T,Vy2  A7\  VZ2  AT  elements  of  the 
parameter  vector  0\ .  Finally, 


where 


(H2\ 


h2-= 


\MlJ 


(3-61) 


and 


M 2  06jc12  , 

'  f' 


/:= 


(3,62) 

(3-63) 


f  W  \ 


w= 


w. 


mn(N+l)+l 


w 

y  rr  m/i(Af+l)+6  j 


(3-64) 


Additionally,  a  weighting  matrix,  R,  is  included,  similar  to  equation  (2-9),  to  correctly 
incorporate  the  confidence  levels  in  the  “reference”  receiver’s  (user  #2)  position  and 
velocity,  and,  possibly,  clock  bias  prior  information.  This  finally  yields 

elM)  =  (Hi (0<° )  R-' Hi 0 9 f  ))_I  (Hx  (02(,) )Y  R~l[Z  +  H2 (0f )  ■  02(O  -  f  (02(/) )]  (3-65) 


where  R  is  a  [nm(N+l)+6]  x  [nm(N+l)+6]  diagonal  matrix 

R=Diag(R1,R2),  (3-66) 

and  where 


3-15 


R , -a 


2  I 


mn(N+l ) 


(3-67) 


is  determined  by  the  measurement  noise  variance  a  and  the  diagonal  R2  contains  the 
standard  deviations  of  the  reference  station’s  position  and  velocity  prior  information,  viz.. 


where 


R2  = 


V 

•*02 

0 

0 

0 

0 

0 


0 

0 

0 

0 

0 


0 

0 

7l 

0 

0 

0 


0 

0 

0 

Ty 

v*2 

0 

0 


0 

0 

0 

0 

rv 

yi 

0 


0 

0 

0 

0 

0 


(3-68) 


6x6 


mn(AT+l)+l) 


,2 


O'- 


crz02  =E(Wmn(N+ D+3) 

&vx2  =E(Wmn(N+ D+4) 

&V„  =E(Wmn(N+ 0+5) 


=m : 


s) 


(3-69) 


In  effect,  we  examine  the  effects  of  inserting  a  column  of  ones  in  the  regressor 
matrix,  H,  which  is  intended  to  absorb  truncation  errors  caused  by  linearization  of  the 
RHS  of  equation  (3-26).  This  also  has  the  effect  of  allowing  the  estimation  of  clock  bias 
differences,  as  indicated  in  Equation  (3-49);  however,  we  are  mainly  concerned  with  the 
estimation  of  user  l’s  position  and  velocity  variables. 
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3.4  Summary 

This  chapter  has  described  the  theory  and  overall  implementation  methodology  of  the 
developed  algorithm.  Alternative  decentralized  estimation  algorithms  are  outlined  in 
Appendix  A.  Chapter  4  presents  the  simulation  results  of,  and  validates,  the  algorithm’s 
ability  to  correctly  estimate  the  parameters  of  interest. 
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4  Simulation  Results 


4.1  Overview 

This  chapter  presents  the  results  of  the  testing  of  the  novel  DGPS  algorithm.  The 
estimation  of  the  position  and  velocity  of  the  mobile  users  is  investigated. 

4.2  Simulation  Scenarios 

Several  cases  are  examined  and  are  summarized  in  Table  2. 


Table  2.  Simulation  Scenario  Summary 


Scenario 

Reference 

Accuracy 

a(m) 

Receiver 

Noise  a  (m) 

Time 

Duration  (s) 

Number  of 

Measurement 

Epochs 

Number  of 
Satellites,  n 

Satellite  Clock 
Bias  Ts(m) 

Notes 

fl 

2 

5 

5 

100 

Prior  Reference  Position  and  Velocity  Information 

B 

2 

3 

5 

Prior  Reference  Position  and  Velocity  Information 

B 

0.0001, 
0.75,  1.5, 

5,  10 

3 

D 

100 

Prior  Reference  Position  Information  Only 

D 

10 

11 

D 

100 

Prior  Reference  Position  Information  Only 

E 

1 

11 

100 

Prior  Reference  Position  Information  Only 

F 

11 

5 

30 

Prior  Reference  Position  and  Velocity  Information 

G 

JgJggj 

5 

D 

100 

Prior  Reference  Position  and  Velocity  Information 

H 

- 

2 

5 

m 

100 

No  Prior  Information 

1 

1 

8 

Prior  Reference  Position  and  Velocity  Information 

J 

0.0001 

1 

1 

8 

100 

Single  Difference  DGPS 

In  all  the  simulation  scenarios,  two  (m= 2)  mobile  users  traverse  parallel  tracks. 


approximately  180  nautical  miles  above  the  surface  of  the  earth  and  separated  by  10,000 
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meters.  The  users’  velocities  are  100  meters  per  second  in  the  jc-direction 

(VXi  =100 ml s,VX2  =100 ml  s)  and  zero  in  the  y  and  z-directions.  Both  of  the  users’  clock 

biases  are  fixed  at  five  meters  (rk  =5  meters) .  All  satellites  are  subject  to  the  same  clock 
bias,  viz.,  t  =100  meters  for  i  =1,2,...,  n,  with  the  exception  of  Scenario  F. 

In  the  simulation  experiment,  the  actual  user  2  initial  position  is  randomly  chosen  and 
is  normally  distributed  about  the  nominal  initial  position  according  to  the  a  specified  in 
the  table;  the  latter  gauges  our  confidence  in  the  user  2  positioning  prior  information. 
Both  the  nominal  user  2  initial  position  and  the  a  information  are  provided  to  the  DGPS 
estimation  algorithm,  but  not  the  actual  user  2  position  used  to  generate  the  pseudorange 
data  given  to  the  algorithm.  Finally,  the  algorithm’s  performance  is  gauged  by  measuring 
the  distance  of  the  computed  position  estimate  from  the  actual  true  position.  This  applies 
to  both  user  1  and  user  2.  For  each  simulation  scenario,  100  Monte  Carlo  runs  were 
performed.  Ten  iterations  (L=10)  for  the  Iterated  Least  Squares  (ILS)  algorithm  were 
performed  for  all  Scenarios. 

4.2.1  Modeling  Methodology 

The  simulation  experiment  examines  the  situation  of  two  mobile  users  moving  along 
parallel  tracks  over  a  specified  (short)  time  interval.  The  number  of  satellites  in  view  of 
both  receivers  is  held  constant  at  five  for  Scenarios  A-F  and  eight  for  Scenarios  G-J).  A 
flow  chart  of  the  steps  taken  during  the  simulation  is  depicted  in  Figure  3. 
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Figure  3.  Simulation  Experiment  Flow  Chart 


4.2.2  Statistics  Examined 

Of  course,  of  paramount  interest  in  examination  of  the  data  was  to  determine  how 
well  the  algorithm  was  able  to  estimate  the  position  and  velocity  of  the  two  receivers. 
The  users’  positions  were  compared  to  the  true  (known)  positions.  The  Root  Mean 
Square  of  these  error  terms  was  calculated  as 


where 


I  y2  +y2  +72 

I  ~~  Error  ~ 1  Error  ~  ^ Error 


(4-1) 
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(4-2) 


100 

£(*-**) 
*= 1 


100 


^(y-9k) 


100 


L  Error 


’  ^ F.rrnr 


k=  1 


'Z(z-Zk) 


Z 


k= 1 


100  '  Error  100  ’  ^Error  100 


The  experimental  covariance  was  calculated  at  the  end  of  the  100  Monte  Carlo  runs 


as 


^"exp 


1 


100 

SIM 

k=1 


(4-3) 


100 


Additionally,  the  predicted  covariance  was  calculated  as  the  average  of  the  predicted 
covariance 


predicted 


-1 


(4-4) 


100 


Where  <7^ ,  ,  <7^  is  comprised  of  the  relevant  diagonal  components  of 


(H{ O,)  . 


4.3  Simulation  Results 

The  data  generated  from  the  simulations  is  documented  in  Appendix  A.  The 
algorithm’s  ability  to  accurately  estimate  the  parameters  of  interest  to  the  users  was 
dependent  on  the  accuracy  of  the  reference  station’s  prior  information.  Uncertainty  in  the 
reference  position  has  a  slightly  greater  impact  on  the  ability  of  the  algorithm  to  estimate 
the  users’  parameters  than  the  receiver’s  noise  variance. 
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4.3.1  Effects  of  Varying  Reference  Position  Accuracy  and  Receiver  Noise 

The  effect  of  varying  both  the  uncertainty  in  the  reference  position  and  the  receiver 
noise  (utilizing  Scenario  B’s  data)  on  the  algorithm’s  ability  to  estimate  the  user’s 
position  is  illustrated  in  Figure  4. 


Figure  4.  Position  Estimation  Error  Trend  By  Varying  Parameters 

Similarly,  the  effect  of  varying  the  receiver  noise  intensity  and  the  reference  receiver’s 
positioning  accuracy  on  the  users’  velocity  estimate  is  shown  in  Figure  5. 


Figure  5.  Velocity  Estimation  Error  Trend  By  Varying  Parameters 
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4.3.2  Results  Utilizing  Five  Satellites 

Scenarios  A  and  B  entailed  prior  information  on  User  2’s  position  and  velocity 
whereas  scenarios  C-E  utilized  only  User  2’s  position  information.  Interestingly,  the 
scenarios  without  prior  velocity  information  yielded  slightly  better  positions,  and 
approximately  equal  velocity  information  for  User  1. 

The  effect  of  having  varying  degrees  of  accuracy  in  the  reference  receiver’s  position 
and  velocity  information  in  Scenarios  A-E  is  further  examined  in  Figures  6  and  7.  From 
Figure  6,  with  a  fixed  receiver  noise  intensity  of  1.5  meters,  it’s  obvious  that  the 
algorithm’s  ability  to  accurately  estimate  User  l’s  position  deteriorates  rapidly  as  the 
uncertainty  in  the  reference  position  increases.  In  general,  after  approximately  1  meter  of 
error  in  the  reference  position,  the  algorithm  produces  large  (>  50m),  and,  possibly 
unacceptable  errors. 


Figure  6.  Effects  of  Reference  Position  Error  On  Position  Estimation  Error 
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Similarly,  Figure  7  depicts  the  algorithm’s  ability  to  estimate  User  l’s  velocity  for 
Scenarios  A-F  with  a  fixed  receiver  noise  of  1.5  meters.  A  more  linear  dependence  of  the 


errors  on  the  reference  position  accuracy  is  evident  as  the  accuracy  in  the  reference 


position  decreases. 


Figure  7.  Effects  of  Reference  Position  Error  On  Velocity  Estimation  Error 

Figures  8  and  9  examine  Scenarios  A-E  when  the  receiver  noise  is  varied  and  the 


accuracy  of  the  reference  station  is  held  to  1.5  meters.  The  1.5-meter  values  used  for  the 
receiver  noise  and  reference  position  accuracy  was  chosen  because  it  represents  the 
average  value  simulated  for  the  respective  noises. 
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Receiver  Noise  Error  (m) 


Figure  8.  Effects  of  Receiver  Noise  Intensity  On  Position  Estimation  Error 


Receiver  Noise  Error  (m) 

Figure  9.  Effects  of  Receiver  Noise  Intensity  On  Velocity  Estimation  Error 

As  expected,  the  algorithm  provides  worse  estimates  as  the  receiver  noise  increases. 
While  the  position  accuracy  is  only  slightly  better  than  in  the  previous  case  where  the 
receiver  noise  is  held  constant  and  the  reference  station  accuracy  is  varied,  the  velocity 
error  is  slightly  worse. 
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Scenario  D  was  devised  to  see  if  not  having  prior  velocity  information  over  a  longer 
observation  interval  (10  seconds)  would  have  a  noticeable  detrimental  effect.  The  results 
(see  Table  13  and  Table  14)  indicate  that  the  algorithm  is  able  to  estimate  the  parameters 
to  a  similar  degree  of  accuracy  as  when  using  prior  velocity  information. 

A  scenario  (F),  with  a  smaller  degree  of  range-equivalent  satellite  clock  bias  (isv), 
was  examined.  The  data  is  presented  in  Table  17  and  Table  18.  As  expected,  the  overall 
magnitude  of  the  errors  was  reduced  while  following  the  same  trends  as  indicated  in  • 
Figures  6-9. 

4.3.3  Results  Utilizing  Eight  Satellites 

The  number  of  satellites  visible  to  the  users  was  increased  from  5  to  8  for  Scenarios 
G-J.  The  purpose  of  including  these  Scenarios  was  to  examine  the  effect  of  introducing 
both  more  satellites  and  improved  geometry  on  the  algorithm’s  ability  to  estimate  the 
parameters  of  interest.  The  additional  three  satellites  were  chosen  from  the  available 
constellation  to  provide  the  best  geometry  for  solving  for  the  kinematic  variables. 

Scenarios  G  and  H  were  simulated  with  eight  satellites  (n=8)  over  a  time  duration  of 
two  seconds  (Ts  =  2)  and  a  sample  rate  of  0.5  seconds  (AT).  As  shown  in  Table  19  and 
Table  20,  the  estimates  were  slightly  improved  from  those  obtained  in  the  previous 
scenarios  for  Scenario  G,  while  Scenario  H  displayed  the  expected  results  of  not 
incorporating  the  prior  information  of  the  User  2’s  position  and  velocity. 
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4.3.3. 1  Single  Measurement  Epoch 


Scenarios  I  and  J  examine  the  effects  of  conducting  a  single  epoch  measurement  with 
n=8  (eight  satellites)  and  good  satellite  geometry.  As  shown  in  Table  3,  the  novel 
algorithm  was  able  to  estimate  the  position  of  the  users  accurately.  The  realized  standard 
deviations  for  the  positions  show  that  this  was  slightly  worse  solution  than  that  obtained 
with  more  measurement  epochs. 


Table  3. 


)  Users’  Position  and  Si 

gma  Values  (] 

V=l,  n=8,  Z 

Reference 
Accuracy  (m) 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Predicted 
User  1  Pos. 
0(m) 

0.0001 

0.75 

0.501 

1.583 

0.0001 

1.5 

0.875 

2.945 

0.0001 

5 

0.841 

9.599 

0.75 

0.75 

0.502 

2.003 

0.75 

1.5 

1.571 

0.75 

5 

0.353 

9.664 

1.5 

0.75 

0.907 

5.151 

1.5 

1.5 

2.944 

5.615 

1.5 

5 

1.558 

10.550 

5 

0.75 

2.535 

10.073 

5 

1.5 

2.913 

10.302 

5 

5 

3.930 

Finally,  Scenario  J  was  conducted  to  compare  the  data  obtained  from  Scenario  I  with 


the  estimation  performance  of  a  conventional  pseudorange  differencing-based  algorithm 


as  described  in  Chapter  2.  The  results  from  this  simulation  indicate  that  the  conventional 


algorithm  produced  comparable  results  to  those  produced  in  Scenario  I,  provided  that  the 


reference  station’s  (User  2)  position  is  accurately  known  ((jRef =  0.0001m). 


Table  4.  Position  Errors  For  Conventional  E 

IGPS  (n=l 

S,N=1) 

Receiver 
Noise  (m) 

Userl 
Position 
Error  (m) 

Userl 

Clock  Error 
(m) 

Predicted 
User  1  Pos. 
a(m) 

Exp.  Userl 
Pos.  a  (m) 

Predicted 
User  1 
Clock  a  (m) 

Exp.  Userl 
Clock  a  (m) 

0.75 

-0.534 

0.983 

0.688 

0.495 

1.5 

-0.441 

1.355 

0.688 

1.048 

5 

0.528 

-0.082 

7.100 

0.688 

3.508 
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4.3.4  Analysis  of  Relative  Distance 


The  estimation  of  the  relative  distance  between  the  two  users  was  also  examined. 


The  results  are  presented  in  Table  5.  In  all  Scenarios,  the  magnitude  of  the  relative 
distance  error  was  less  than  the  absolute  positioning  errors.  This  indicates  that  the  errors 
affecting  the  algorithm’s  ability  to  correctly  resolve  the  parameters  affects  both  users. 


Table  5.  Relative  Distance  Errors 


Reference 

Receiver 

Noise 

(m) 

Scenario 

Scenario 

Scenario 

Scenario 

Scenario 

Scenario 

Scenario 

Scenario 

Accuracy  (m) 

A 

B 

c 

D 

E 

F 

G 

H 

0.0001 

0.75 

■OfcrZM 

0.607 

0.432 

0.535 

5.739 

0.0001 

1.5 

1.010 

0.326 

0.528 

0.627 

0.437 

16.839 

20.763 

0.0001 

5 

0.544 

0.581 

0.244 

0.337 

61.649 

21.676 

0.75 

0.75 

14.524 

8.760 

0.188 

6.343 

6.156 

11.321 

4.044 

31.805 

0.75 

1.5 

12.048 

16.374 

2.034 

0.095 

15.387 

25.930 

35.547 

31.870 

f  0.75 

5 

69.900 

27.546 

4.271 

33.574 

92.805 

9.327 

53.98 

1.5 

0.75 

12.246 

12.493 

7.632 

37.828 

1.5 

1.5 

26.122 

37.696 

13.935 

MUlk&M 

54.151 

KEESHI 

206.721 

367.860 

1.5 

5 

37.389 

36.064 

24.483 

7.917 

34.877 

323.568 

622.387 

5 

0.75 

6.308 

1.053 

47.593 

85.898 

43.317 

122.176 

■Sanaa 

5 

1.5 

45.457 

21.143 

35.265 

81.764 

60.051 

212.942 

221.462 

713.341 

5 

5 

5.870 

95.507 

31.118 

60.695 

12.014 

3.445 

168.773 

387.616 

4.3.5  Analysis  of  Clock  Errors 

As  seen  from  Equation  (3-52),  the  new  parameter  vector^  does  not  strictly  attempt  to 
estimate  the  user  and  satellite  clock  values.  Instead,  a  linear  combination  of  clock  errors 
terms  is  estimated.  Since,  in  the  simulation,  the  users  have  equal  clock  biases  and  the 
satellites  have  equal  clock  biases,  the  algorithm  should  produce  near  zero  estimates 
except  for  the  additive  clock  error  addition  where  User  2’s  clock  error  term  is  added  to 
the  clock  bias  of  satellite  5. 

This  combination  should  have  the  effect  of  ‘collecting’  modeling  errors  introduced 
into  the  linear  regression  by  linearization.  As  can  be  seen  from  Table  6  (or  graphically  in 
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Figure  10  for  Scenario  B),  the  algorithm  consistently  produces  the  expected  results  for 


the  (T1-T2)  term. 


Table  6.  Transformed  Clock  Variables 


Reference 

Accuracy 

(m) 

Receiver 
Noise  (m) 

Q 

r2+rJs 

(m) 

(m) 

Q 

0.0001 

0.75 

-0.034 

5.045 

-0.011 

-0.063 

MEESEBH 

-0.028 

0.0001 

1.5 

-0.089 

5.070 

-0.078 

0.015 

0.011 

0.059 

0.0001 

5 

-0.033 

4.862 

0.182 

0.278 

0.129 

0.158 

0.75 

0.75 

0.087 

17.371 

-0.197 

-20.227 

2.636 

-19.911 

0.75 

1.5 

0.178 

30.116 

-1.080 

-45.673 

-13.272 

-26.159 

0.75 

5 

0.045 

7.589 

85.913 

29.785 

69.589 

1.5 

0.75 

0.053 

20.244 

-0.071 

-26.232 

-2.961 

-19.439 

1.5 

1.5 

0.066 

-9.871 

28.928 

40.662 

14.369 

30.774 

1.5 

5 

-0.010 

-131.456 

100.679 

289.549 

79.108 

205.322 

5 

0.75 

-0.053 

-43.120 

75.820 

108.145 

-21.389 

140.537 

5 

1.5 

-0.092 

-75.103 

148.258 

193.167 

-20.328 

}M  1  'll  1 1 M 

5 

5 

-0.256 

-131.729 

226.813 

302.238 

-103.528 

441.550 

10 

0.75 

-0.082 

-14.536 

150.171 

87.854 

-41.653 

169.766 

10 

1.5 

0.062 

-24.641 

134.501 

-50.512 

244.681 

10 

5 

0.450 

-213.808 

307.755 

494.541 

-17.351 

548.593 

However,  the  algorithm  only  was  able  to  produce  the  near  the  desired  estimates  when 
the  reference  station’s  position  uncertainty  and  receiver  noise  were  less  than  1  meter. 


Number  of  Monte  Carlo  Runs 


Figure  10.  Clock  Performance  Trend 
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4.4  Summary 

This  chapter  presented  the  performance  results  of  the  novel  algorithm  described  in 
Chapter  3.  The  algorithm  was  able  to  predict  the  users’  positions  and  velocities  within 
expected  levels.  It  was  observed  that  uncertainty  in  the  reference  position  had  a  slightly 
greater  effect  on  the  estimation  of  the  parameters  than  did  variation  of  the  receiver  noise 
intensity.  Note,  however,  that  the  novel  algorithm  allows  for  accounting  for  the  degree  of 
uncertainty  in  the  reference  station’s  position. 

A  significant  change  in  the  algorithms’  estimation  performance  was  not  evident  with 
an  increase  in  the  duration,  T,  of  the  observation  interval.  The  performance  does  slightly 
improve  with  the  number  of  satellites  visible  to  the  receivers.  Additionally,  the 
comparison  of  the  novel  algorithm  with  conventional  DGPS  techniques  over  a  single 
measurement  epoch  yielded  similar  results.  All  of  the  data  generated  from  the 
simulations  are  included  in  Appendix  A. 


5  Conclusions 


5.1  Overview 

This  thesis  presents  the  theory,  modeling  methodology  and  results  of  a  novel  DGPS 
algorithm  that  estimates  mobile  users’  position  and  velocity.  Also  presented  are 
recommendations  for  future  research  topics  stemming  from  this  research. 

5.2  Conclusions 

A  novel  DGPS  algorithm  was  developed  to  estimate  users’  positions  and  velocities 
utilizing  only  pseudorange  measurements.  Simulations  were  performed  to  validate  the 
algorithm’s  ability  to  estimate  the  variables  of  interest. 

One  of  the  benefits  of  using  the  novel  algorithm  is  its  ability  to  account  for  the  level 
of  uncertainty  in  the  reference  receiver’s  position.  As  expected,  it  was  shown  that  the 
results  are  very  dependent  on  the  accuracy  of  the  reference  station’s  position.  When 
uncertainty  in  the  reference  station’s  position  or  velocity  information  was  introduced,  the 
algorithm’s  estimates  were  correspondingly  in  error.  Also,  since  the  kinematics  of  the 
platforms  were  modeled  accurately,  there  was  not  a  significant  error  introduced  as  the 
duration,  T,  was  increased. 

5.3  Recommendations 

The  following  are  possible  extensions  of  this  research 
1.  The  current  algorithm  incorporates  a  simple  linear  motion  model  into  the  algorithm. 

A  more  realistic  model  could  be  introduced  to  better  represent  the  motion  of  a  user. 
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For  this  example,  since  the  receiver  platforms  were  satellites,  a  Keplerian  model 
could  easily  be  incorporated. 

2.  Since  carrier  phase  measurements  are  inherently  more  accurate,  allowing  the 
algorithm  to  utilize  carrier  phase  measurements  should  greatly  decrease  the  errors  in 
estimating  both  position  and  velocity  of  the  users. 

3.  Since  the  algorithm  has  the  ability  to  weight  measurements,  enhance  the  algorithm  to 
process  both  pseudorange  and  carrier  phase  measurements  simultaneously  is 
recommended. 
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Acronym  List 


AFTT 

Air  Force  Institute  of  Technology 

AFRL 

Air  Force  Research  Laboratory 

CPGPS 

Carrier  Phase  Global  Positioning  System 

DCM 

Direction  Cosine  Matrix 

ECEF 

Earth-Centered,  Earth-Fixed 

EKF 

Extended  Kalman  Filter 

GPS 

Global  Positioning  System 

INS 

Inertial  Navigation  System 

PR 

Pseudorange 

RMS 

Root-Mean-Square 

SA 

Selective  Availability 

SV 

Satellite  Vehicle 

GDOP 

Geometric  Dilution  Of  Precision 

UERE 

User  Equivalent  Range  Error 

ACR-l 


Appendix  A:  Simulation  Results 


Table  7.  (A)  Position  and  Velocity  Errors  (AT=0.5s,  T=2s) 


Reference 
Accuracy  (m) 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

0.0001 

0.75 

0.121 

0.025 

0.000 

0.000 

0.0001 

1.5 

0.105 

0.009 

0.000 

0.000 

0.0001 

5 

0.170 

0.166 

0.000 

0.000 

0.75 

0.75 

9.522 

0.120 

14.074 

0.75 

1.5 

20.635 

43.202 

0.089 

18.381 

0.75 

5 

40.844 

0.065 

TIN  til 

1.5 

0.75 

0.145 

mmzm 

1.5 

1.5 

21.873 

0.139 

1.5 

5 

108.567 

95.764 

0.148 

5 

0.75 

55.732 

89.215 

0.576 

120.701 

5 

1.5 

93.957 

268.863 

0.580 

227.931 

5 

5 

198.026 

317.622 

0.438 

328.642 

10 

0.75 

109.641 

247.502 

0.851 

266.362 

10 

1.5 

156.964 

0.225 

10 

5 

192.048 

249.430 

1.415 

193.762 

Table  8.  (A)  Predicted  and  Exp,  a  Values  (AT=0.5s,  T=2s) 


Reference 

Accuracy 

(m) 

Receiver 
Noise  (m) 

Predicted 

User  1  Pos. 
o(m) 

Predicted 

User  1  Vel. 
a(m) 

Predicted 

User  2  Pos. 
a(m) 

Predicted 

User  2  Vel. 
a(m) 

Exp.  Userl 

Pos .  a  (m) 

Exp.  Userl 
Vel.  a  (m) 

Exp  User2 

Pos.  a(m) 

Exp.  User2 
Vel.  a(m) 

■timing 

0.75 

0.966 

0.301 

0.000 

■EXD23H 

wwm 

0.000 

meesm 

0.0001 

1.5 

1.932 

■Bl 

■H:iM 

0.000 

MMi’i’iM 

0.0001 

5 

6.441 

mcM 

0.000 

6.507 

0.000 

0.000 

0.75 

0.75 

1.328 

0.750 

6.066 

0.300 

0.780 

8.258 

0.75 

1.5 

2.233 

0.602 

0.750 

0.615 

0.802 

12.973 

0.75 

5 

6.613 

0.750 

1.939 

0.757 

2.299 

1.5 

0.75 

1.871 

0.301 

1.500 

0.290 

8.178 

0.280 

1.500 

12.051 

1.5 

1.5 

2.657 

0.602 

0.530 

1.503 

25.298 

1.5 

5 

6.943 

1.070 

MHHT'M 

■Bnti 

1.421 

8.313 

5 

0.75 

5  124 

0.301 

0.309 

4.999 

47.886 

5 

1.5 

5.481 

0.602 

5.000 

0.594 

24.213 

0.593 

5.156 

93.017 

5 

5 

8.855 

2.006 

5.000 

WWW 

4.907 

55.791 

10 

0.75 

10.061 

0.301 

75.271 

10.363 

81.878 

10 

1.5 

10.249 

0.602 

46.201 

M‘HTf 

9.986 

129.583 

10 

5 

12.473 

2.006 

10.000 

1.935 

53.081 

2.038 

10.111 

175.158 

A-l 


0.0001 


0.0001 


0.75 


0.75 


0.75 


1.5 


0.080 


0.101 


0.535 


23.364 


20.492 


45.821 


.5 

1 

.5 

5 

S2IMBESE 

8 

0.10 

86.100 


34.682 


127.494 


29 


505.847 


564.642 


1033.223 


0.000 


0.000 


0.035 


0.107 


0.186 


3 


0.228 


0.529 


0.953 


3 


0.000 


0.000 


0.000 


13.941 


12.501 


2.884 

48.909 


43.047 


29.541 


219.899 


136.687 


163.460 


301 .496 


544.950 


647.628 


0.673 

0.000 

1.197 

0.671 

1.346 

0.000 

1  0.000  i 

2.427 

1.288 

1.326 


12.434  4.094 


8.041 


1.339 

23.515 

4.440 

0.662 

19.831 

0.688 

0.000 


10.126 

3.365 


0.930 


15.009 

13.385 

10.448 


68.235 


62.518 


49.168 


100.141 


Table  11.  (C)  Position  and  Velocity  Errors  (AT=ls,  T=2s,  w/o  Prior  Vel.  Data) 


Reference 
Accuracy 
(m)  ' 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

0.0001 

0.75 

0.069 

0.032 

0.000 

0.024 

0.0001 

1.5 

0.112 

0.081 

0.000 

0.062 

0.0001 

5 

0.409 

0.497 

0.000 

0.438 

0.75 

0.75 

1.946 

13.257 

0.095 

2.644 

0.75 

1.5 

3.665 

38.353 

0.126 

24.411 

0.75 

5 

42.187 

0.096 

■fF'ff 

1.5 

0.75 

5.954 

23.962 

0.101 

w 1  msm 

1.5 

1.5 

9.692 

63.595 

0.198 

50.150 

1.5 

5 

16.936 

70.103 

0.134 

5 

0.75 

28.236 

98.068 

0.899 

WEMEM 

5 

1.5 

30.856 

124.313 

0.889 

193.204 

5 

5 

48.970 

143.292 

0.491 

207.080 

10 

0.75 

86.177 

362.613 

2.222 

389.846 

10 

1.5 

141.344 

662.599 

0.667 

500.345 

10 

5 

147.069 

799.588 

1.152 

777.950 

Table  12.  (C)  Predicted  and  Exp,  a  Values  (AT=ls,  T=2s,  w/o  Prior  Vel.  Data) 


Reference 

Accuracy 

(m) 

Receiver 
Noise  (m) 

Predicted 

User  1  Pos. 
a(m) 

Predicted 

User  IVel. 
a(m) 

Predicted 

User  2  Pos. 
a(m) 

Predicted 

User  2  Vel. 
a(m) 

Exp.  Userl 

Pos .  a  (m) 

Exp.  Userl 

Vel.  a  (m) 

Exp  User2 

Pos.  o(m) 

Exp.  User2 
Vel.  a(m) 

0.0001 

0.75 

1.359 

0.673 

0.000 

0.673 

1.277 

0.635 

0.000 

0.643 

KEmM 

1.5 

■»!»!»» 

1.346 

2.705 

1.399 

0.000 

1.339 

mrnsm 

■tlil.liM 

4.485 

4.530 

0.000 

4.455 

B3 

MI1TM 

0.673 

Kszm 

0.673 

0.651 

0.689 

7.847 

0.75 

1.5 

2.818 

1.346 

0.750 

1.346 

4.287 

1.386 

0.783 

15.431 

0.75 

5 

9.091 

4.486 

0.750 

4.485 

4.703 

0.707 

1.5 

0.75 

2.020 

0.673 

1.500 

0.673 

0.685 

1.670 

19.904 

1.5 

1.5 

3.100 

1.346 

1.500 

1.346 

1.308 

1.511 

22.356 

1.5 

5 

9.182 

4.486 

1.500 

4.485 

10.572 

4.412 

1.569 

18.775 

5 

0.75 

KXEfcHI 

0.673 

16.913 

0.745 

4.954 

5 

1.5 

5.000 

1.346 

19.542 

1.266 

4.911 

66.586 

5 

5 

10.334 

4.486 

5.000 

4.485 

21.351 

4.195 

4.845 

52.430 

10 

0.75 

10.088 

0.673 

10.000 

■fl.-WcM 

0.669 

9.813 

102.063 

10 

1.5 

10.356 

1.346 

45.037 

1.368 

11.068 

176.748 

10 

5 

13.467 

4.486 

10.000  | 

4.485 

37.847 

4.099 

10.013 

123.594 
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Table  13.  (D)  Position  and  Velocity  Errors  (AT=ls,  T=10s,  w/o  Prior  Vel.  Data) 


Reference 
Accuracy 
(m)  ' 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

0.0001 

0.75 

0.089 

0.007 

0.000 

0.011 

0.0001 

1.5 

0.076 

0.004 

0.000 

0.005 

5 

0.387 

0.088 

0.000 

0.029 

0.75 

0.75 

10.623 

44.466 

24.835 

0.75 

1.5 

15.068 

29.197 

0.096 

35.867 

0.75 

5 

24.457 

40.134 

0.090 

1.5 

0.75 

24.686 

50.680 

0.082 

1.5 

1.5 

30.545 

70.146 

0.063 

44.069 

1.5 

5 

52.454 

107.299 

0.142 

90.908 

5 

0.75 

74.645 

0.444 

198.974 

5 

1.5 

50.587 

347.772 

0.370 

354.519 

5 

5 

88.012 

331.813 

0.849 

331.081 

10 

0.75 

138.213 

490.363 

319.184 

10 

1.5 

278.136 

391.972 

510.012 

10 

5 

249.348 

346.496 

0.315 

Table  14.  (D)  Predicted  and  Exp,  o  Values  (AT=ls,  T=10s,  w/o  Prior  Vgl 


.  Data) 


n  % 

«  o 
oC  Z 


TJ  O 
u  Dh 

t>  *“»  ^ 
'■3  S3  E 

£  D  b 


TJ  « 
«  > 
O  i— 

1  8 


U  (N  ^ 

g  «  E 
£  D  b 


0)  p> 
D 


8 

so 

D  b 


k.  c 

W 

D  b 


*  o 

UJ  On 


8  § 

3  e 

S-5 
w  > 


&8 

OQ  On 


fc  6 

CO  ' — " 

D  b 
cx  — 

w  > 


0.0001 

0.0001 

~).00Q1 

0.75 

0.75 

0.75 

1.5 

1.5 

1.5 

_5 _ 

_5 _ 

_5 _ 

10 

10 

10 


0.75 

1.5 

5 

0.75 

1.5 

5 

0.75 

1.5 

5 

0.75 

1.5 

5 

0.75 

1.5 

5 


0.815 

1.630 

5.434 

1.106 

1.793 

5.486 

I. 706 
2.213 
5.636 
5.064 
5.256 
7.376 
10.030 
10.129 

II. 371 


0.091 

0.181 

0.605 

0.091 

0.181 

0.605 

0.091 

0.181 

0.605 

0.091 

0.181 

0.605 

0.091 

0.181 

0.605 


0.000 

0.000 

0.000 

0.750 

0.750 

0.750 

1.500 

1.500 

1.500 

5.000 

5.000 

5.000 

9.999 

10.000 

10.000 


0.091 

0.181 

0.604 

0.091 

0.181 

0.604 

0.091 

0.181 

0.604 

0.091 

0.181 

0.604 

0.091 

0.181 

0.604 


0.825 

I. 652 
5.389 
7.259 
4.523 
9.055 

II. 992 
14.058 
19.791 
57.225 
62.337 
35.900 
112.815 
77.728 
92.155 


0.095 

0.187 

0.651 

0.077 

0.184 

0.638 

0.095 

0.184 

0.555 

0.089 

0.179 

0.559 

0.100 

0.190 

0.609 


0.000 

0.000 

0.000 

0.780 

0.741 

0.751 

1.469 

1.466 

1.569 

5.275 

5.175 

4.815 

10.477 

10.336 

9.761 


0.089 
0.184 
0.601 
16.176 
1 1 .605 
8.253 
17.979 
18.235 
25.370 
120.993 
69.288 
47.352 
252.383 
109.298 
86.017 
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Table  15.  (E)  Position  and  Velocity  Errors  (AT=0.1s,  T=ls,  w/o  Prior  Vel.  Data) 


Reference 
Accuracy 
(m)  ' 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

iHn 

0.75 

0.074 

0.000 

0.008 

0.0001 

1.5 

0.102 

0.007 

0.000 

0.022 

0.0001 

5 

0.136 

0.083 

0.000 

0.034 

0.75 

6.75 

4.204 

16.381 

0.064 

8.288 

0.75 

1.5 

13.947 

28.286 

0.048 

20.766 

0.75 

5 

26.981 

24.399 

0.034 

20.005 

1.5 

0.75 

69.744 

26.760 

0.280 

34.320 

1.5 

1.5 

110.278 

34.385 

0.179 

15.596 

1.5 

5 

123.048 

48.960 

0.274 

52.765 

5 

0.75 

182.231 

153.778 

0.151 

73.967 

5 

1.5 

165.995 

198.152 

0.738 

178.045 

5 

5 

150.214 

357.960 

0.704 

322.350 

10  ! 

0.75 

254.858 

335.030 

1.237 

332.509 

10 

1.5 

296.913 

455.474 

1.187 

337.648 

10 

5 

299.469 

656.191 

1.351 

536.431 

Reference 

Accuracy 

(m) 

Receiver 
Noise  (m) 

Predicted 
User  1 

Pos.  a(m) 

Predicted 
User  IVel. 
a(m) 

Predicted 
User  2 

Pos.  o(m) 

Predicted 
User  2 

Vel.  a(m) 

Exp.  Userl 
Pos  .  a  (m) 

S3  6 

Cfl  w 

UJ  > 

Exp  User2 
Pos.  a(m) 

*2  e 

Q  c 

C/3  >w' 

O  t> 
d,  -4 

W  > 

|  0.0001 

0.75 

0.815 

0.091 

0.000 

0.095 

■iimitiM 

1.5 

Bm 

0.181 

■»1H1 

1.686 

0.000 

0.186 

BBB 

IHEaHI 

■«»■!«!«■ 

0.605 

5.365 

0.000 

■eehm 

HSZ9I 

(■SIdfl 

0.091 

4.719 

0.737 

1.5 

MEM 

0.181 

0.750 

0.181 

5.490 

0.696 

5.377 

5 

0.750 

0.605 

■BSHiMI 

0.532 

■S9 

9.227 

1.5 

0.75 

1.706 

1.500 

0.092 

13.377 

1.5 

1.5 

2.213 

■mw 

1.500 

12.772 

0.192 

win  p 1  ji 

16.726 

1.5 

5 

5.637 

0.605 

■ossm 

0.605 

19.710 

0.592 

14.975 

5 

0.75 

WEEsSJM 

keeumi 

63.592 

5 

1.5 

■ JES3M 

5 

5 

■miiM 

4.753 

10 

0.75 

10.031 

0.091 

10.000 

0.091 

92.336 

10.090 

94.315 

10 

1.5 

■ni*feu 

0.181 

0.181 

57.472 

0.164 

10.140 

162.576 

10 

5 

0.605 

■hxhimI 

0.605 

92.283 

0.562 

10.579 

92.118 
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Table  17.  (F)  Position  and  Velocity  Errors  (AT=0.1s,  T=ls,  TSV=30m) 


Reference 
Accuracy 
(m)  ' 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

—  *“7  * 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

0.75 

0.057 

0.008 

0.000 

0.000 

1.5 

0.082 

0.012 

0.000 

0.000 

5 

0.098 

0.036 

0.000 

0.000 

0.75 

0.75 

11.934 

MS3B5I9 1 

0.071 

0.75 

1.5 

40.327 

■ 

0.030 

0.75 

5 

127.203 

46.973 

0.075 

29.089 

1.5 

0.75 

64.656 

61.068 

0.054 

55.207 

1.5 

1.5 

57.417 

143.444 

0.178 

97.838  | 

1.5 

5 

77.496 

160.669 

0.125 

142.050 

5 

0.75 

151.865 

234.798 

0.899 

189.707 

5 

1.5 

238.569 

336.639 

0.514 

298.967 

5 

5 

221.235 

501.094 

1.122 

409.442 

10 

0.75 

160.973 

562.276 

0.778 

485.530 

10 

1.5 

282.283 

831.210 

0.795 

657.617 

10  |  5  | 

154.141 

1313.504 

0.736 

1054.391 

Table  18.  (F)  Predicted  and  Exp,  p  Values  (AT=0 


g  2 

2>  2 
u  3 
c:  o  ^ 

<d  o  a 

OC  <  S 

Receiver 

Noise  (m) 

Predicted 

User  1  Pos. 
o(m) 

Predicted 

User  IVel. 
a(m) 

Predicted 

User  2  Pos. 
a(m) 

- - 

Predicted 

User  2  Vel. 
a(m) 

S  E 

D  t) 

d  </i 
x  o 

W  CL 

- 7  * 

Is  B 

05  w 

^  t> 

S'  5 

'J  •-'VMM 

Si  ? 

CD  w 

3  * 

O-  05 

X  o 

W  CL 

Exp.  User2 

Vel.  a  (in) 

IKKU 

0.75 

0.681 

0.091 

0.000 

0.000 

0.643 

0.091 

0.000 

0.000 

0.0001 

1.5 

1.362 

0.181 

0.000 

0.000 

1.385 

0.207 

0.000 

0.000 

0.0001 

5 

4.541 

0.605 

0.000 

0.000 

4.292 

0.598 

0.000 

0.000 

0.75 

0.75 

1.104 

0.091 

0.750 

0.090 

9.248 

0.102 

0.789 

12.292 

0.75 

1.5 

1.772 

0.181 

0.750 

0.172 

7.059 

0.192 

0.769 

8.291 

0.75 

5 

5.058 

0.605 

0.750 

0.423 

17.741 

0.584 

0.730 

8.406 

1.5 

0.75 

1.705 

0.091 

1.500 

0.090 

13.163 

0.089 

1.441 

21.929 

1.5 

1.5 

2.208 

0.181 

1.500 

0.179 

14.625 

0.174 

1.499 

22.742 

1.5 

5 

5.458 

0.605  1 

1.500 

0.533 

22.757 

0.603 

1.547 

14.341 

5 

0.75 

5.064 

0.091 

5.000 

0.091 

44.698 

0.084 

5.256 

48.377 

5 

1.5 

5.256 

0.181 

5.000 

0.181 

44.327 

0.173 

4.791 

79.700 

5 

5 

7.361 

0.605 

5.000 

0.597 

55.483 

0.546 

4.824 

55.813 

10 

0.75 

10.031 

0.091 

10.000 

0.091 

107.375 

0.079 

9.819 

131.843 

10 

1.5 

10.129 

0.181 

10.000 

0.181 

74.259 

0.181 

10.018 

98.750 

10 

5 

11.369 

0.605 

10.000 

0.603 

65.062 

0.612 

10.495 

146.767 
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Table  19.  (G)  Position  and  Velocity  Errors  (n=8,  AT=0.5s,  T=2s) 


Reference 

Accuracy 

(m) 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

0.0001 

0.75 

3.744 

14.164 

0.052 

13.701 

0.0001 

1.5 

10.105 

0.112 

19.913 

memm 

5 

76.074 

0.067 

17.414 

0.75 

0.75 

14.082 

0.155 

70.574 

0.75 

1.5 

0.253 

26.483 

0.75 

5 

28.400 

0.029 

36.528 

1.5 

0.75 

60.803 

240.029 

0.719 

110.769 

1.5 

1.5 

144.471 

288.930 

0.227 

261.866 

1.5 

5 

193.363 

0.256 

286.149 

5 

0.75 

177.225 

400.646 

1.829 

273.685 

5 

1.5 

206.973 

367.725 

1.153 

452.736 

5 

5 

286.712 

586.073 

1.358 

468.085 

10 

0.75 

3.744 

14.164 

■EBXH 

10 

1.5 

10.105 

34.275 

0.112 

—UfcWcl 

10 

5 

76.074 

49.446 

0.067 

M5E5EM 

Table  20.  (G)  Predicted  and  Exp,  a  Values  (n=8,  AT=0.5s,  T=2s) 


Reference 

Accuracy 

(m) 

>  w 
•9*  flj 

8  .a 

<D  O 

&  Z 

T3  P 
ft)  Cu 

lit 

(EDO 

T3  JU 
£  > 

%  u  '£ 

£  D 

•S«£ 

U  ft  ^ 

1  8  S. 

(EDO 

•o  5 

ft) 

O  ft  ^ 

1  s  s 

£  D  e 

Exp.  Userl 
Pos .  0  (m) 

ft)  S 

^  D 
d  — : 

x  ft) 

B3  > 

Si 

00 

D  0 

D-  oo 
&  £ 

<N  O 
ft)  3 

on  w 

D  0 

d  — : 
x  « 

BU  > 

0.0001 

0.179 

0.173 

3.957 

0.190 

0.756 

0.0001 

1.5 

1.729 

0.359 

0.750 

■UKiM 

7.531 

0.364 

0.791 

8.234 

0.0001 

5 

1.195 

0.750 

0.610 

HESZSS 

1.206 

0.700 

3.163 

0.75 

0.75 

1.500 

0.178 

0.187 

1.461 

0.75 

1.5 

1.500 

0.346 

1.452 

41.047 

0.75 

5 

5.346 

1.195 

1.500 

0.897 

15.003 

1.128 

1.387 

12.334 

1.5 

EEE3H 

0.179 

34.865 

0.160 

5.065 

78.510 

1.5 

1.5 

IHkiilf 

kllKW 

0.357 

4.711 

1.5 

5 

■any 

■HIM 

1.153 

32.173 

5.186 

IBM 

5 

0.75 

10.025 

0.179 

10.000 

104.954 

5 

1.5 

10.105 

10.000 

■ma« 

65.897 

0.328 

10.697 

101.361 

5 

M 

■raw 

MM 

10.000 

94.376 

1.288 

10.632 

WKEEEEM 1 

10 

KS9I 

MBEM 

0.750 

0.173 

0.190 

0.756 

10 

1.5 

1.729 

0.359 

■ifcJdiMI 

7.531 

0.364 

0.791 

8.234 

10 

5 

5.049 

1.195 

0.750  | 

0.610  | 

14.709 

1.206 

0.700 

3.163 
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T able  21.  (H)  Position  and  Velocity  Errors  (n=8,  AT=0.5s,  T=2s) 


Reference 
Accuracy 
(m)  ' 

Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

User2 
Position 
Error  (m) 

0.0001 

0.75 

HEI33SH 

0.000 

0.0001 

1.5 

6.000 

0.0001 

5 

0.255 

6.000 

0.75 

0.75 

4.600 

0.056 

0.75 

1.5 

22.792 

0.055 

0.75 

5 

99.354 

0.116 

1.5 

0.75 

9.679 

0.122 

1.5 

1.5 

0.231 

1.5 

5 

138.666 

0.125 

5 

0.75 

36.017 

0.229 

5 

1.5 

89.793 

0.418 

5 

5 

10 

0.75 

27.168 

10 

1.5 

85.704 

1.035 

10 

5 

17.576 

1.483 

Table  22.  Predicted  and  Exp,  a  Values  (n=8,  AT=0,5s,  T=2s) 


O  - 

a  i 

5  ^ 

<u  o  a 

Pi  <  B 

<U  o 
cc  Z 

oi 

jit 

£  D  D 

Predicted 

User  2  Pos. 
o(m) 

&  B 

Ml  w- 

^  O 

&  s 

W  Ou 

6  t 

Ml  i- 

D  G 

O-  co 

X  o 

W  0- 

0.0001 

0.75 

1.732 

_ 0.714 

0.0001 

1.5 

1-743 

■ESS 

0.000 

Km 

5 

1.732 

5.129 

0.000 

0.75 

0.75 

■E9 

0.002 

3.071 

0.732 

0.75 

1.5 

1.222 

0.002 

7.738 

0.758 

0.75 

5 

0.475 

0.002 

18.152 

0.755 

1.5 

0.75 

IKEZSI 

0.001 

8.753 

1.472 

1.5 

1.5 

0.001 

10.417 

1.457 

1.5 

5 

0.422 

0.001 

25.375 

1.540 

5 

0.75 

0.342 

0.001 

44.340 

5.153 

5 

1.5 

0.333 

0.001 

28.225 

5.033 

5 

5 

0.262 

0.001 

35.210  | 

5.053 

10 

0.75 

0.173 

0.001 

61.491 

9.071 

10 

1.5 

0.172 

0.001 

44.584 

9.752 

10 

5 

0.157 

0.001 

74.473 

9.820 
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Table  2; 


3.  Position  and  Velocity  Errors  (n=8,  AT=0.5s,  T=2s, ,  w/o  Prior  Vel.  Info.) 


Receiver 
Noise  (m) 

Userl 

Position  Error 
(m) 

Userl 
Velocity 
Error  (m) 

User2 
Position 
Error  (m) 

User2 
Velocity 
Error  (m) 

0.75 

659.091 

0.027 

659.014 

0.025 

1.5 

■EEEBiEH 

0.048 

0.102 

5 

0.227 

0.171 

Table  24.  Position  and  Velocity  Errors  (n=8,  AT=0.5s,  T=2s,  w/o  Prior  Vel.  Info.) 


Receiver 
Noise  (m) 

Predicted 
User  1  Pos. 
a(m) 

•a  "w 

3  > 

ji  i 

CD  o 

1/5 

T3  P 
<D  CU 

O  N  ^ 

iss 

£  D  t> 

•a  5 
«  *> 

O  N  ^ 

‘■S  S3  £ 

£  D  t) 

Exp.  Userl 
Pos.  a  (m) 

Exp.  Userl 
Vel.  a  (m) 

Exp  User2 

Pos.  a(m) 

Exp.  User2 
Vel.  a(m) 

0.75 

2978.031 

0.158 

2978.699 

0.158 

2933.082 

0.160 

0.160 

1.5 

5912.051 

0.317 

0.317 

5887.641 

0.303 

5888.969 

5 

19535.204 

1.058 

19539.733 

1.058 

18600.126 

1.036 

18604.904 

1.051 
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Appendix  B:  Decentralized  Approaches 


Measurement  noise  effects  mitigation  in  GPS/DGPS  -  Indirect  approach 

Assume  that  at  the  conclusion  of  the  ILS  iteration  sequence,  the  vehicle’s  position 
vector  satisfies 

x  =  N(x,P)  (B-l) 

where 

P  =  a21 3  (B-2) 

Here,  the  position  equation  can  be  considered  as 

x=jc+v  (B-3) 


where 

£(vvr)=P=<r2/3  (B'4> 

While  standard  DGPS  techniques  obtain  a  precise  estimate  of  position,  the  receiver 
measurement  noise  is  increased  (see  Table  1).  Rather  than  fight  the  ill  effects  of 
measurement  noise  at  the  reference  station  algorithm  level,  a  centralized  and  therefore 
theoretically  more  rigorous  (and  better)  algorithm  is  developed.  Specifically,  one 
stipulates  the  following  behavioral  assumption  concerning  the  vehicle’s  dynamics 


,  x  1  2 
jc(f)=*0  +vt+— at 
2 


(B-5) 


where  the  three  (unknown)  vectors  x0 ,  v,  a  e  91" ,  (n  =  9) .  A  temporal  horizon,  T,  is 
chosen  such  that  0  <  t  <  T.  Therefore,  the  parameter  vector  is 


B-l 


f  Y  A 
A0 


0  = 


V  a  ) 


6  R9 


(B-6) 


A  sampling  interval,  AT,  is  also  chosen  which  allows  defining  the  number  of  samples  as 


N  =■ 


AT 


(B-7) 


The  choice  of  T  and  AT  is  determined  by  the  dynamics  and  maneuverability  of  the 
vehicle  under  consideration.  Also  for  estimation  purposes,  it  is  desirable  to  have 

N  >  2n2  (B-8) 

The  available  GPS  measurements  are  of  the  form 


Z,  =  x(iAT),  i  =  0,1,...,  A 


(B-9) 


A  moving  data  window  will  be  used  to  solve  the  least  squares  problem  in  the  vector 
parameter  of  interest,  0,  i.e. 

mnXK>'A7-)-z|  (B- 10) 

1=0 


Now,  Equation  (B-5)  is  written  as 

x(iAT)  =  xe  +  v  •  (iAT)  +  a^(  i  AT2 ) 
=  [I3iiA  3^(iA  2I3]  0 

Defining  the  matrix 

Ml3>5=[i3:oAr)/3;i(iAr)2/3] 


(B-ll) 


(B-12) 


allows  Equation  (B-l  1)  to  be  re-written  as 


B-2 


x(iAT)=M,0 


(B-13) 


Using  the  new  notation,  the  cost  function  to  be  minimized  becomes 

J=X|x(iAT)-Z,|;=X(Ht0-Zi>T(M,e-Z1) 


(B-14) 


1=0 


i=0 


Since  the  cost  function  is  quadratic,  setting  the  derivative  to  zero,  i.e.,  can  minimize  it. 

dJ 


=  0 
d0 

which  yields 

SM’(M,e-Z,)  =  0 

i=0 

^<2M>Hi>8  =  £m|z, 

i=0 

Solving  for  the  parameter  vector  of  interest  as 

MjXM.r'SXz, 

i=0 

Now, 


N 

2 

i=0 

N 

2 

i=0 


mJm,  = 


/3  (iAT)i,  y2mfh 

(iAT)I,  (/A  T)2I3  Y2m?h 

[y2aAT)2i3  y2a ad3/3  y4aAT)4i3 


To  allow  further  simplification  of  the  notation,  define 


(B-15) 


(B-16) 


(B-17) 


(B-18) 


(B-19) 


Therefore, 


B-3 


(B-20) 


n 

SH[Z,= 


i=0 


1=0 

A  £x(iA 
^A  2£x(iA 


Simpler  Notation 

If  the  vehicle  dynamics  are  rather  benign,  the  vehicle’s  position,  Equation  (B-5)  can 
be  simplified  by  removing  the  acceleration  term.  This  will  result  in  a  less  accurate 
solution,  but  simplifies  required  computations.  The  simplified  position  equation  can  be 
written  as 


x(iAT ) = x0  +  v  •  (iAT) 

with  a  parameter  vector  consisting  of  the  variables  of  interest 

f  xn  } 


(B-21) 


(B-22) 

Now,  the  cost  function  can  be  similarly  developed,  as  in  Equation  (B-14),  and  defined 


as 


IV 

•/  =  o  +  vi AT  -  Z,. )  (x0  +  viAT  -  Z,. ) 


1=0 


=  E x0  x0  +  (AT)2 /  Vv  +  Z,TZ,  +  2x0rvA77  -  2jc0rZ,.  -2A TivrZi 


(B-23) 


The  minimization  of  Equation  (B-23) 

min  Yj  kT*o  +  (vAT)r  (vA T)  +  2ixT0  (vAT)  -  2x\Zi  -  2 Z]  (vAT)/] 

6  t=0 


(B-24) 


B-4 


yields 


'^x0+i(vAT)  =  ±Z, 

/=0  i=0 

2**0  +i2(vAT)=^iZt 


(B-25) 


This  allows  for  solving  of  the  vector  0  by 


N  + 1  -N(N  + 1) 

2  Q-  i= 0 

\N(N+ 1)  iiV(iV  +  l)(2iV  +  l)  JiZ, 


(B-26) 


or,  after  re-arranging  terms. 


-N  —N(2N  +  l) 
2  6 


yv 

.  sz- 

.  1  t=0 

"  +  1  ±B, 


(B-27) 


Now,  solving  for  0  yields 


-  12  —  Af(2Af  +  l) 

0  = - — -  6  , 

yv(N+2)  _1N 

2 


1  “I  * 

■\n  ,  £z, 

1  "+1  i/z,. 


(B-28) 


permits  explicitly  expressing  the  variables  of  interest  as 


5  -  2<2"  +  1>  fZ  6  ffZ 

0  (iV  +  l)(yV  +  2)^  '  (Af  +  l)(Af  +  2)6  ‘ 


(B-29) 


A7v= - - - Yz,.+ - — - YiZ, 

(7V  +  l)(iV  +  2)^  N(N  +  l)(N  +  2)£t 


(B-30) 


B-5 


Examples 


For  the  situation  where  N=1  and  using  Equations  (B-29)  and  (B-30)  yield 

*0 = m 


as  expected.  For  the  case  N  =  2, 


AT 


1 


(B-31) 


=— [5jc(0)  +  2ic(l>  -  Jc(2)] 


1 


(B-32) 


2AT 


[x(2)-x(0)] 


and,  similarly,  for  the  case  when  N=3, 


1 


=  -Um  +  4Jc(l)  +  x(2)  -  2Jc(3)] 


1 


(B-33) 


10AT 


[- 3x(0)  -  jc(l)  +  jc(2)  +  3x(3)] 


Of  course,  solving  for  cases  where  N  >  1  require  the  knowledge  of  previous  values, 
i.e.  for  the  case  of  N=3  would  require  knowledge  of 

x(0),  £(1),  x(2),  and  x(3)  (B-34) 

The  notation  can  be  improved  to  allow  easier  reading.  For  the  case  of  N=3,  let 


l(0)=^[7x(0)  +  4*(1)  +  x(2)  -  2x(3)l 


(B-35) 


and 


i(l)=i(0)  +  vAT 

=  ~[7^(°)  +  4x(l)  +  x(2)  -  2Jc(3)]+-1[-3*(0)  -  x(l)  +  x{2)  +  3x(3)]  (B_36) 
=  ~[4^(0)  +  3*(1)  +  2x(2)  +  x(3)] 


B-6 


Actually,  we  are  interested  in  the  (improved)  estimate  of  the  state  at  time  3,  i(3) ,  now 


£(3)  =  JE(0)  +  3(vAT) 

=^-[7Jc(0)  +  4Jc(l)  +  x(2)  -  2x(3)  -  9Jc(0)  -  3Jc(l)  +  3Jc(2)  +  9x(3» 


(B-37) 


which  gives, 


i(3)  =  ^[-2x(0)  +  Jc(l)  +  4Jc(2)  +  7Jc(3)]  (B-38) 

Therefore,  we  have  obtained  the  causal  FIR  filter  structure 

1(3)  =  ^*(3)  +  ^*(2)  +  ^*(1)  - 1^(0)  (B-39) 


or, 

kk) = 0.7 x(k) + 0.4x(k  - 1) + 0. lJc(A:  -  2)-0.2x{k  - 3)  (B-40) 

This  is  a  weighted  sum  of  the  current  and  previous  state  estimates.  Note  that  the 
current  state  estimates  ( x(k ) )  are  weighted  the  heaviest  as  expected.  The  deleterious 

effects  of  measurement  noise  on  x(3)  have  now  been  removed.  In  addition,  an  estimate 
of  the  vehicle’s  velocity  is  obtained. 

Therefore,  kinematic  GPS  addresses  and  mitigates  the  ill  effects  of  measurement 
noise.  We’d  like  to  think  of  the  proposed  method  as  ‘Indirect  Kinematic  GPS’  or  IKGPS. 
The  algorithm  is  based  on  batch  processing  of  the  data.  The  data  consists  of  a  moving 
window.  The  ensuing  algorithm  is  an  FIR  filter,  albeit  not  all  its’  weights  are  positive, 
although  the  sum  of  the  weights  is  always  equal  to  1,  i.e. 

^weights = 1  (B-41) 
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A  proposition  is  that  the  sum  of  the  weights  of  the  FIR  filter  for  position  estimation  is 
always  equal  to  1 .  In  addition,  the  sum  of  the  weights  of  the  FIR  filter  for  velocity 
estimation  is  always  equal  to  zero. 
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